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Preface 


In  the  past  two  decades,  one  of  the  major  stumbling  blocks  in  apply¬ 
ing  optimal  control  theory  to  flight  control  problems  has  been  that 
measurements  of  all  the  states  of  the  system  are  not  available.  Thus, 
it  is  necessary  to  use  some  type  of  observer  or  filter  to  reconstruct  the 
states  of  the  aircraft.  However,  when  this  is  done,  all  guarantees  of 
desirable  stability  robustness  properties  are  lost.  This  thesis  addresses 
this  problem  and  evaluates  the  success  of  some  techniques  to  recover 
the  good  stability  robustness  properties  associated  with  full-state  feed¬ 
back. 
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committee  members.  Professors  John  J.  D'Azzo  and  Robert  Calico  for  their 
suggestions  and  comments.  Finally,  I  wish  to  thank  Captain  Richard  Floyd 
for  his  assistance  in  modifying  and  correcting  the  computer  programs  used 
to  accomplish  this  project. 
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Abstract 


This  study  examines  the  concept  of  robustifying  a  controlled  system 
against  differences  which  may  exist  between  the  real  world  system  and  the 
low-order  design  model  upon  which  the  controller  design  is  based.  The 
types  of  controllers  considered  are  based  upon  the  Linear  system  model, 

\  f 

Quadratic  cost,  and  Gaussian  (LQG)  noise  process  methodology  of  optimal 
control  theory.  It  is  assumed  that  full-state  feedback  is  not  available 
and  a  Kalman  filter  is  employed  to  provide  state  estimates  to  the 
controller.  Both  continuous- time  and  sampled-data  controllers  are  con¬ 
sidered  . 

Two  robustif lcation  techniques  are  considered.  The  first  is  the 
method  of  injecting  zero-mean  white  Gaussian  noise  into  the  design  model 
at  the  point  of  entry  of  the  control  inputs  during  the  process  of  tuning 
the  Kalman  filter.  The  second  method  is  an  extension  of  the  first,  where 
the  white  noise  is  replaced  by  a  time-correlated  noise.  This  allows  the 
primary  strength  of  the  noise  to  be  concentrated  only  in  the  frequency 
range  where  robustif lcation  is  desired.  Comparing  the  results  of  applying 
the  two  methods  allows  a  designer  to  make  a  trade-off  between  the  amount 
of  desired  robust if lcation  and  the  performance  degradation  at  the  design 
conditions  which  occurs  when  the  techniques  are  applied. 

Both  methods  are  found  to  improve  substantially  the  robustness 
properties  of  the  controllers  considered.  For  the  specific  flight  control 
problem  considered  in  this  thesis,  the  technique  of  injecting  white  input 

noise  into  the  design  model  produced  the  desired  degree  of  robustif lcation 

\ 

without  prohibitively  degrading  performance  it  the  design  conditions. 


xiv 


The  second  method,  though  effective,  did  not  yield  substantial 
enough  performance  benefits  over  the  first  to  warrant  use  in  actual 
implementation . 


ROBUST  FLIGHT  CONTROLLERS 


I.  Introduction 


1.1  Background 

A  vital  element  of  a  flight  control  system  is  that  it  be  "robust". 
Robustness  implies  that  the  controller  provides  adequate  (i.e.,  stable 
closed- loop)  performance  over  a  wide  range  of  operating  conditions  and 
system  parameters.  For  example,  finite-dimension  models  of  the  dynamics 
of  an  aircraft  are  typically  generated  by  linearizing  the  aircraft  equa¬ 
tions  of  motion  about  a  limited  number  of  specific  equilibrium  flight 
conditions.  Controllers  are  then  designed  for  these  "trim"  conditions. 
However,  at  flight  conditions  other  than  the  specific  trim  condition  used 
for  controller  design,  the  closed-loop  performance  of  the  controller  system 
may  be  inadequate  or  unstable.  That  is,  at  the  off-design  flight  condi¬ 
tion,  the  aircraft  parameters  (upon  which  the  design  is  based)  have 
changed  sufficiently  to  make  performance  of  the  controller  inadequate. 

One  method  used  in  the  past  has  been  to  schedule  feedback  gains  for  the 
controller  so  as  to  compensate  for  the  change  in  system  parameters.  How¬ 
ever,  it  is  desirable  to  have  enlarged  regions  about  nominal  design  condi¬ 
tions  within  which  a  specific  controller  design  will  yield  adequate  perform¬ 
ance.  This  would  allow  linear  perturbation  techniques  to  be  used  with  more 
confidence  and  may  also  reduce  the  number  of  required  design  conditions 
about  which  such  perturbations  are  defined.  It  may  even  be  desirable  to 
have  a  fixed  controller  which  is  sufficiently  robust  to  produce  acceptable 
performance  for  all  conditions  in  the  aircraft's  flight  envelope. 


Robustness  is  also  a  concern  when  controllers  are  designed  using 
purposefully  reduced  order  models.  A  robust  controller  will  provide 
stable  closed-loop  performance  even  when  states  of  the  real-world  system 
have  been  ignored  in  the  design  model.  A  third  robustness  issue  is 
survivability.  Robustness  can  also  imply  the  ability  to  maintain  closed- 
loop  stability  if,  for  instance,  part  of  the  flight  control  system  is  lost 
due  to  ground  fire:  i.e.,  the  "true"  system  is  vastly  different  than  the 
system  model  upon  which  the  controller  was  designed.  Such  a  robust 
controller  will  provide  a  stable,  though  degraded,  aircraft  performance 
while  adaptation  algorithms  attempt  to  discern  what  system  elements  have 
been  lost  and  to  determine  an  appropriate  modification  of  controller 
characteristics  for  future  use. 

In  the  1960's,  modern  control  theory  methods,  such  as  optimal  control 
theory,  showed  promise  in  application  to  flight  control  problems.  One 
drawback  of  applying  optimal  control  theory  techniques  to  flight  control 
problems,  however,  is  that  the  resulting  controllers  require  full-state 
feedback,  but  measurements  of  all  states  are  generally  not  available. 

Thus,  it  becomes  necessary  to  include  a  filter  or  observer  in  the  con¬ 
trolled  system  to  estimate  the  states.  However,  once  an  observer  has  been 
inserted  into  the  loop,  stability  robustness  becomes  a  major  concern 
(Ref  5). 

Recently,  efforts  to  improve  the  robustness  properties  of  observer- 
based  controllers  have  included  a  technique,  developed  by  J.C.  Doyle  and 
G.  Stein  (Ref  6),  which  injects  white  noise  into  a  controller  system  model 
at  the  point  of  entry  of  the  control  inputs  during  the  process  of  tuning 
the  Kalman  filter.  It  is  claimed  that,  as  the  strength  of  the  input  noise 


is  increased,  the  filter-based  controller  will  asymptotically  recover  the 
good  robustness  properties  of  a  full-state  feedback  system  in  the 
continuous-time  case.  A  disadvantage  of  this  technique  is  that  the 
additional  noise  can  degrade  the  performance  of  the  system  at  the  design 
conditions . 

A  natural  extension  to  the  idea  of  injecting  white  input  noise  into 
a  system  model  is  to  consider  time-correlated  noise.  This  allows  the 
robustif ication  technique  to  be  applied  only  over  a  desired  frequency 
range  rather  than  over  all  frequencies  as  in  the  original  Doyle  and  Stein 
method.  Thus,  the  degradation  in  performance  due  to  the  additional  noise 
can  be  reduced  (Ref  15; 16; 28). 

The  techniques  described  above  are  applied  in  this  thesis  to  a 
specific  aircraft  flight  control  problem.  Two  types  of  controllers  are 
considered.  The  first  is  an  optimal  Linear  Quadratic  Gaussian  (LQG) 
regulator.  Available  software  allows  the  design  of  a  continuous- time 
and  a  digital  controller.  The  second  type  of  controller  is  an  optimal 
LQG-based  Proportional-plus- Integral  digital  controller.  For  both  types 
of  controller,  a  Kalman  filter  is  implemented  to  provide  estimates  of 
the  states  of  the  system.  The  success  of  applying  the  robustif ication 
techniques  is  determined  by  designing  a  Kalman  filter  and  controller  for 
one  trim  condition,  then  evaluating  the  performance  of  the  controller  at 
an  off-design  flight  condition,  as  well  as  designing  the  filter  and  con¬ 
troller  on  the  basis  of  purposely  reduced-order  models  for  computational 
loading  reasons.  Time  histories  of  the  mean  and  standard  deviations  of 
the  aircraft  states  and  controls  are  examined.  Additionally,  it  is  desired 
to  compare  the  performance  of  the  controller  at  the  design  conditions  with 


no  input  noise,  white  noise  and  time-correlated  noise  used  for  filter 
retuning  (robustification)  to  determine  how  much  the  performance  is  de¬ 
graded  by  the  input  of  the  noise,  and  also  to  determine  if  performance 
benefits  can  be  gained  by  using  time-correlated  noise  as  opposed  to 
white  noise. 

1.2  Problem 

The  primary  objectives  of  this  thesis  are: 

1.  To  apply  the  robustification  techniques  of  injecting  white  or 
time-correlated  noise  into  a  system  model  at  the  control  entry 
points  during  filter  tuning  to  a  flight  control  problem  for  a 
high  performance  aircraft. 

2.  To  extend  the  techniques  for  LQG  regulators  to  LQG-based  PI 
controllers . 

3.  To  evaluate  the  robustness  properties  of  the  controller  designs 
by  performing  covariance  analyses  for  the  controlled  systems  at 
both  the  design  flight  condition  and  other  off-design  conditions 
within  the  aircraft's  operational  flight  envelope,  using  a 
purposefully  reduced-order  design  model.  Robustlfied  designs 
are  to  be  compared  to  unrobustifled  designs  and  also  to  full- 
state  feedback  designs  when  possible. 

1.3  Sequence  of  Presentation 

The  body  of  this  thesis  is  contained  in  Chapter  II-V.  Chapter  II 


presents  the  equations  used  for  designing  and  evaluating  optimal  determin¬ 
istic  LQG  regulators  for  both  the  contlnous-  and  discrete-time  case. 


Also  Included  Is  the  application  of  the  Doyle  and  Stein  technique  to 
continuous-time  systems  and  several  extensions  of  the  technique  to 
discrete-time  systems. 

Chapter  Ill  presents  the  equations  necessary  to  design  and  evaluate 
optimal  LQG-based  PI  controllers  for  the  discrete-time  case.  Then  the 
Doyle  and  Stein  technique  is  applied  to  systems  employing  PI  controllers. 
As  pointed  out  in  the  text,  robustlf ication  by  this  technique  is  a  pro¬ 
cedure  which  affects  only  the  Kalman  filter  design;  thus,  the  same  method 
is  used  for  PI  controllers  as  for  regulators  in  this  thesis. 

Chapter  IV  examines  the  idea  of  injecting  time-correlated  noise 
rather  than  white  noise  into  a  controlled  system  model  during  tuning 
of  the  filter,  to  Improve  the  tradeoff  of  the  controller's  robustness 
properties  versus  performance  degradation  at  design  conditions.  First, 
a  stochastic  process  model  (shaping  filter)  is  developed  for  the  noise 
process  which  is  then  augmented  with  the  system  state  differential  equa¬ 
tions.  Then,  the  types  of  time-correlated  noise  of  interest  to  this 
thesis  are  considered,  including  a  discussion  of  the  specific  shaping 
filters  to  generate  the  desired  noise  process. 

Chapter  V  presents  the  model  of  a  high-performance  aircraft  to  be 
used  in  this  thesis.  A  design  flight  condition  is  chosen  and  linearized 
perturbation  equations  of  motion  are  developed  for  the  aircraft  about 
that  operating  point.  The  design  model  for  the  Kalman  filter  and  con¬ 
troller  is  purposefully  reduced  in  order  from  the  full  set  of  linearized 
equations  so  that  this  aspect  of  robustness  can  be  examined.  Finally, 
models  at  other  flight  conditions  are  listed  with  which  the  robustness 
of  the  system  to  parameter  changes  will  be  evaluated. 


The  findings  of  this  thesis,  results  and  conclusions  are  presented  in 
Chapter  VI.  Recommendations  for  further  research  are  made  in  Chapter  VII 
Four  appendices  are  included.  The  first  presents  a  generic  format 
for  a  controller  into  which  the  types  of  controllers  in  Chapters  II  and 
III  can  be  rearranged.  The  usefulness  of  the  format  becomes  apparent 
in  a  performance  analysis,  when  the  same  set  of  equations  can  be  used 
to  evaluate  the  performance  of  any  controller  in  the  standard  format. 

Appendix  B  lists  the  source  code  for  a  Fortran  program  used  in  design 
lng  LQG  regulators.  Included  are  a  discussion  of  how  the  program  is 
executed  and  modifications  from  a  previous  version  to  allow  the  input 
of  time-correlated  noise  (Ref  21). 

Appendix  C  lists  the  modification  to  the  software  of  Reference  13  and 
30  to  allow  the  input  of  white  and  time-correlated  noise  into  the  system 
model.  The  software  is  an  interactive  program  used  for  designing  PI 
regulators  with  a  Command  Generator  Tracker  in  the  feed-forward  loop. 

This  thesis  will  exploit  only  the  PI  regulator  design  capabilities. 

Appendix  D  includes  further  performance  analysis  results  in  addition 
to  the  findings  in  Chapter  VI.  It  was  stated  in  Reference  6  that  the 
Doyle  and  Stein  technique  is  not  guaranteed  to  improve  robustness  if 
the  design  model  is  non-minimum  phase  (i.e.,  there  are  transmission 
zeroes  in  the  right-half  s-plane) .  Appendix  D  shows  a  case  where  the 
design  model  was  non-minimum  phase  and  where  the  addition  of  input 
noise  to  the  system  model  has  actually  drive  an  initially  stable  closed- 
loop  system  to  be  unstable. 


II.  LQG  REGULATORS 


2.1  Introduction 

This  chapter  presents  the  equations  used  in  designing  optimal  Linear 
Quadratic  Gaussian  (LQG)  controllers  for  a  system  modelled  as  linear, 
time- invariant,  and  driven  by  zero-mean,  white  Gaussian  noise  and  deter¬ 
ministic  Inputs,  subject  to  quadratic  costs  for  defining  optimality 
criteria.  The  model  used  for  this  thesis  is  described  in  Chapter  V.  The 
methods  used  are  taken  primarily  from  Reference  24  unless  otherwise 
stated. 

In  the  first  section,  the  controller  equations  for  a  continuous¬ 
time  system  having  continuous-time  measurements  are  given.  The  structures 
of  controllers  assuming  perfect  access  to  all  the  states  of  a  system 
versus  controllers  with  a  Kalman  filter  to  estimate  states  are  examined. 
Next,  the  equations  needed  to  evaluate  the  performance  of  controller 
designs  are  given.  Finally,  a  technique  developed  by  Doyle  and  Stein 
(Ref  6)  to  robustify  the  Kalman  filter  for  continuous- time  systems  is 
presented . 

The  fourth  section  contains  the  controller  equations  for  a  continuous- 
time  system  having  sampled-data  measurements.  Next  the  performance  analy¬ 
sis  equations  for  the  sampled-data  system  are  developed. 

The  final  sections  contain  alternative  methods  for  applying  the 
Doyle  and  Stein  technique  to  sampled-data  systems.  Three  possible  basic 
approaches  are  simply  to  discretize  the  controller  designed  for  the  con¬ 
tinuous  system  or  to  modify  the  technique  in  one  of  two  ways  so  that  it 
applies  directly  to  a  discrete  system. 


All  methods  described  in  this  chapter  are  incorporated  in  a  Fortran 


program  originally  written  by  Captain  Eric  Lloyd  and  modified  to  some 
extent  by  this  author.  For  source  codes  and  information  about  the  pro- 
gram,  see  Reference  21.  Modifications  and  additions  to  the  program  are 
listed  in  Appendix  B. 


2.2  Continuous-Time  Controllers 

The  state  description  for  an  important  class  of  continuous- time 
systems  is  given  by  the  linear  stochastic  differential  equation 


x(t)  -  F(t)  x(t)  +  B(t)  u(t)  +  G(t)  w(t)  (2-1) 

where  w(t)  is  a  white  Gaussian  noise  with  statistics 

E{w(t)}«0  (2-2a) 

E{w(t)  wT(t+T)}  *  Q(t)6(x)  (2-2b) 


An  optimal  LQG  controller  for  the  system  minimizes  the  cost 
functional 
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where  W^(t)  is  a  positive  semi-definite  weighting  matrix  associated  with 
the  system  states,  x(t);  wuu(t)  Is  a  positive  definite  weighting  matrix 
associated  with  the  controls,  _u(t),  applied,  to  the  system;  wxU(fc)  Is  a 
cost-weighting  matrix  associated  with  cross  terms  of  x(t)  and  u(t)  and  is 


chosen  so  that  the  composite  matrix  of  Equation  (2-3)  is  positive  semi- 


definite;  and  X^  is  a  positive  semi-definite  weighting  matrix  associated 
with  the  states  at  the  final  time,  x(t^) . 

The  optimal  control  to  be  applied  at  time  t  which  minimizes  the 
above  cost  function  is  described  as 

u*(t)  -  -  Gc*(t)  x(t)  (2-4) 

* 

with  the  gain  matrix,  (t),  given  by 

G  *(t)  "  W„„_1  BT(t)  (2-5) 

c  uu  c 

and  K^(t)  is  calculated  using  the  backward  Riccati  differential  equation 
-K  (t)  -  FT(t)  K  (t)  +  K  (t)  F(t)  +  W  (t) 

C  C  C  XX 

-  Kc(t)  B(t)  Wuu_1(t)  BT(t)  Kc(t)  (2-6) 

subject  to  the  final  condition 


Kc(tf)  -  Xf  (2-7) 

Notice  that  Equation  (2-6)  assumes  that  the  cross  weighting  matrix 
Wxu(t)  is  zero.  If  this  is  not  the  case,  an  appropriate  variable  trans¬ 
formation  can  be  made  which  will  account  for  the  non-zero  cross  terms  and 
allow  equation  (2-6)  to  be  used  (Ref  24:202-203;  19:79-86). 

Up  to  this  point,  the  controller  equations  have  been  derived  allowing 
for  time-varying  systems,  cost-weighting  matrices  and  feedback  gains. 
However,  as  described  in  Chapter  V,  the  model  used  for  this  thesis  is 
time- invariant  with  stationary  noises  (i.e.,  the  covariance  kernel 


E{  w(t)  wT(t4r)}  is  a  function  of  only  the  time  difference  T  (Ref  23:139- 
140))  and  constant  weighting  matrices.  Thus  a  steady-state  constant  gain 
controller  can  be  used,  ignoring  terminal  transients  in  the  feedback  gain 


At)  -  -Gc*x00  -  -  [wuu_1BT  kJ  x(t)  (2-8) 

where  K  is  now  the  solution  to  the  steady-state  Riccati  equation 
c 


FTK  +KF+W  -K  BW  _1BTK 
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(2-9) 


Henceforth,  the  assumption  of  a  time- invariant  system  with  stationary 
noises  and  constant  weighting  matrices  is  made,  and  the  time  argument  is 
omitted  unless  needed  to  avoid  confusion. 

The  optimal  control  law  of  Equation  (2-4)  is  given  as  a  gain  matrix 
times  the  state  values  at  a  particular  time.  If,  however,  perfect  know¬ 
ledge  of  the  states  is  not  available,  then  an  estimate  of  the  state  , 
x(t),  must  be  used  in  place  of  x(t) .  In  this  case,  a  Kalman  filter  is 
employed  to  evaluate  the  conditional  mean,  x(t) ,  and  conditional  co- 
variance,  P(t),  of  the  states  of  the  system. 

Instead  of  the  actual  values  of  the  states,  assume  that  what  are 
accessible  from  the  system  are  noise-corrupted  measurements  of  the  time- 
invariant  form 


£(t)  -  H  x(t)  +  v(t)  (2-10) 

where  v(t)  is  a  stationary  white  Gaussian  noise  assumed  independent  of 
the  dynamics  driving  noise  w(t)  and  with  statistics 

E{v(t) )  -  0  (2-lla) 

E(v(t)  vT(t+T)}  ■  R6 (t)  (2-lib) 


Then  the  Kalman  filter  equations  yield  an  estimate  of  the  states  and 
the  covariance  via  (Ref  23:257,259) 

x(t)  -  Fx(t)  +  Bu(t)  +  PHTR_1  t^(t)  -  Hx(t) ]  (2-12a) 

P(t)  -  FP(t)  +  P(t)FT  +  GQGT  -  P(t)  HTR-1  HP(t)  (2-12b) 

These  differential  equations  are  solved  forward  in  time  subject  to  the 
initial  conditions 

E{x(t  )>  -  x  (2-13a) 

—  o  — o 

E{  [x(t  )  -  x]  [x(t  )  -  ^]T}  -  Po  (2-13b) 

which  are  obtained  from  an  a  priori  Gaussian  density  function  for  the 
states  at  the  initial  time. 

The  precomputable  Kalman  filter  gain  for  the  continuous-time  system 
is  expressed  in  Equation  (2- 12a)  as 

K(t)  -  P(t)  HTR_1  (2-14) 

If  it  is  assumed  that  the  initial  transients  of  Equation  (2-12b)  are 
short  compared  to  the  total  time  of  interest,  the  steady-state  co- 
variance,  P,  can  be  computed  as  the  solution  to 

£(t)  -  0  -  FP  +  PFT  +  GQGT  -  PHTR_1  HP  (2-15) 

and  the  constant  Kalman  filter  gain  is  given  by 


Do  not  confuse  the  Kalman  Filter  gain,  K,  with  K£  of  Equation  (2-6)  and 
(2-9). 

Figure  (2-1)  shows  the  form  of  the  continuous -time  controller. 
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Figure  2-1:  Continuous  Measurement  LQG  Optimal 
Stochastic  Controller 


2.3  Continuous-Time  Performance  Analysis 

The  performance  analysis  for  a  continuous-time  LQG  controller  is 
based  on  the  development  for  a  sampled-data  controller  given  in  Reference 
23  and  derived  in  Reference  21. 

First,  a  "truth  model"  is  developed  for  a  given  system  which  is 
judged  to  represent  adequately  the  response  of  a  system  to  inputs  and 
disturbances  encountered  in  the  real  world.  Then,  controllers  for  the 
system  can  be  designed,  generally  based  on  lower  order,  simplified  models. 
The  performance  is  determined  by  examining  the  statistical  characteristics 
of  the  truth  model  states,  xt(t),  and  the  controls,  u(t) ,  for  each  pro¬ 
posed  controller  inserted  into  the  real  world  simulation  provided  by  the 
truth  model.  This  is  depicted  in  Figure  (2-2). 
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Figure  2-2:  Performance  Evaluation  for  Linear 
Sampled-Data  Controller 


The  performance  evaluation  determines  the  statistical  characteristics 

of  xft),  the  truth  model  states,  rather  than  the  states  of  the  simplified 
“ t 

controller  model.  It  is  important  to  determine  the  effect  of  applying 
controls  from  a  reduced  order  controller  on  the  actual  system  response. 
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Additionally,  the  statistical  characteristics  of  the  controls  are  examined 
to  ensure  that  they  do  not  exceed  physical  limits  or  design  specifications. 


time 

The  assumed  linear  differential  equation  describing  the 

truth  model  system  and  available  measurements  are 

continuous- 

x.  (t)  -  Fx(t)  +  B.u(t)  +  Gw  (t) 

— t  t“  t t 

(2-17) 

z  (t)  -  Hx(t)  +  v.(t) 

— t  t —  -t: 

(2-18) 

where 

initial  conditions  and  statistics  of  the  noise  are  given  by 

Etit(t0)}  -i  to 

(2-19) 

E<t2,<to)  -  -  5  J>  •  p  to 

(2-20) 

E{w  (t)}  -  0 

— t 

(2-21) 

E{w^(t)  w  T  (t+T)}  -  Q  6(x) 

—z  — t  z 

(2-22) 

E{v  (t)}  -  0 

— t  — 

(2-23) 

E{v.  (t)  v  T(t+t)}  -  R.<5(T) 

- t  - t  t 

(2-24) 

Note  that  v  (t)  and  w  (t)  are  assumed  to  be  independent  of  each  other  and 
— t  — t 

that  the  subscript  t  refers  to  the  truth  model. 

A  useful  form  of  expressing  the  control  law  of  Equation  (2-4)  and 

other  more  general  linear  control  algorithms,  and  an  equation  to  propagate 

the  internal  states  of  the  controller,  are  given  by 

u(t)  -  0cA(t)  *  Gcz  zjt)  +  Gcy  ^(t) 

(2-25) 

x  (t)  -  F  x  (t)  +  B  z  (t)  -  B  y, (t) 
— c  c  — c  cz  — t  cy 


(2-26) 


where  ^(t)  refers  to  a  command  input  for  the  system  controlled  variable, 
jKt),  to  track,  where 

2<t)  -  Cx(t)  +  Dy  u(t)  (2-27) 

The  gain  matrices  in  Equations  (2-25)  and  (2-26)  are  evaluated 
explicitly  in  Appendix  A.  Putting  the  control  law  into  the  generic  form 
allows  direct  comparison  of  different  types  of  linear  control  laws. 

Determination  of  time  histories  are  desired  of  the  mean  and  co- 
variance  of  an  augmented  vector 

(2-28) 

All  quantities  of  interest  in  a  performance  analysis  are  assumed  to  be 
components  or  linear  combinations  of  components  of  this  vector.  If  q^  is 
a  scalar  quantity  of  Interest,  i.e., 

"k  -  \  <2-29> 
then  the  statistics  of  q^  are  given  by 

mean{qk(t)}  -  c^1  m  (t)  (2-30a) 
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(2-30b) 


where  m  (t)  is  the  mean  and  P  (t)  is  the  covariance  of  the  augmented 

Va 

vector  • 

To  evaluated  the  first  two  moments  of  ^(t),  it  is  first  necessary 
to  form  another  augmented  vector  composed  of  the  internal  states  of  the 
truth  model  and  the  controller  model 
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(2-31) 


Using  Equation  (2-18)  and  (2-25),  u(t)  and  z(t)  are  eliminated  from 


Equation  (2-17) 


V'>  ■  <  Ft  +  Bt  GczV  +  VcA(« 


+  BtGcy  2d(t)  +  BtGcz  i(t)  +  GA(t) 


(2-32) 


Similar  substitution  into  Equation  (2-26)  yields 


*,(*>  "  ^(t)  +  BcyZd(t)  +  Bcz[Htxt(t)  +  vt(t)]  (2-33) 


Form  the  augmented  noise  vector 


w*(t) 
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(2-34) 
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as  a  zero-mean  white  Gaussian  noise  with  covariance  kernel 
T 

E{w  (t)w  (t  +r)}«0  6(t),  where 


0 


(2-35) 


a 


Non-zero  cross  terms  can  easily  handle  the  case  of  w.  (t)  and  v.  (t)  being 

— t  “t 

correlated.  Now  an  augmented  system  equation  can  be  written  as 


x^t)  -  P^Ct)  +  B^t)  +  Gv^(t) 


(2-36) 


where 


F  +  B  G  H  B  G 

t  t  cz  t  t  cx 


B  G 
t  cy 


(2-37) 


(2-38) 


G  BG 

t  t  cz 


The  initial  conditions  for  the  augmented  vector  are 


(2-39) 


E{x  (t  )>« 
—a  o 


(2-40) 
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Initial  conditions  on  the  controller  states  are  often  assumed  to  be  zero: 

x  *  0. 

-co  — 

The  mean  and  covariance  of  the  states  in  Equation  (2-36)  propagate 


3*  (t>  “  FaSx  (t)  +  Vd(t) 

a  a 


(2-42) 


P  (t)  -  F  P  (t)  +  P  (t)FT  +  GQGT  (2-43) 
xxv/  a  x  x  '  '  x  x  '  '  a  axa  a 
a  a  a  a  a  a 


or  solving  the  differential  equation  yields 


s*  <t>  -  V'-Viao  +  Aa(t- T>Vd<T)  dT 

a  c 


(2-44) 


Px  x  <£>  -  ♦.<t’t0)Pao*a  “‘V 
a  a 


+  £  «a(t,T)GaQaGaT4>J(t,T)  dx  (2-45) 


where  <5  (t,t  )  is  the  state  transition  matrix  associated  with  F  ,  i.e., 
a  o  a 

4>a(t»to)  “  "  exp 

However,  the  requirement  is  to  solve  for  the  statistics  of  the 
vector  ^(t)  defined  in  Equation  (2-32).  This  vector  is  related  to 


x_(t)  by 


6 


The  vector  is  seen  to  be  a  linear  combination  of  jointly  Gaussian 
variables  with  known  statistics.  Thus,  the  desired  statistics  can  be 
generated  from  Equation  (2-39)  using  the  method  shown  in  Reference  23:112 


m  (t) 

~v 


m  (t)  + 


2d<*> 


G  H 
cz  t 


(2-47) 


P  (t)  - 
v  y 


P  (t) 
xx 
a  a 


G  H  G 
cz  t  cx 


G  H  G 
cz  t  cx 


Vt(t) 


G  H 
cz  t 


p  (t) 

XV 

a  t 


G  H 
cz  t 


vv(t) 


T 

0  G 

a  •> 


(o-L a\ 


In  the  last  term,  note  that  P 


u 

m 


y  v  (t)  -  Rt6(0)  and  that  6(0)  -  ».  This 


terms  gives  an  infinite  value  to  the  lower  right-hand  partition  of  the 


covariance  matrix.  However,  it  is  still  of  interest  to  look  at  the 


contribution  of  the  other  three  terms  separately.  To  evaluate  Equation 


(2-48)  fully,  it  is  necessary  to  find  an  expression  for  P  (t).  This 

XaVt 


can  be  written  as 


P  *  E{  [x  (t)  -  m  (t)][v  (t)  -  m  (t)  ]  } 
x  v  — a  -x  — t  7  -v  ' 

at  a  t 


Expand  this,  noting  that  m  (t)  ■  0 

“^t 


but  E{vJ(t)}»  m  T(t)  ■  0T,  therefore 
~^t 


Px  v  (t)  *  E  {*a(t)^t  (t)> 
a  t 


Replace  x  (t)  with  the  solution  form  for  Equation  (2-36) 


px  v  (t)  -  E(<|.a(t,to)xa(to)vt  (t) 
at 


+  Aa(t,T^Ba2d(T)  dT 

b 

+/Vt,T)Ga2 a(T)  ^tT(t)  dT} 


(2-49) 


PY  v  (t)  -  E{x  (t)v  T(t)  -  m  (t)vT(t)}  (2-50) 

x  v  “^a  — t  — x 

a  t  a 


p  »  E  {x  (t)>r.T(t)}  -  m  (t)E  (vJ^t)}  (2-51) 

at  -a 


(2-52) 


(2-53) 


Making  the  assumption  that  x^t^  and  v  (t)  are  independent  (and  thus 

uncorrelated),  the  first  term  in  Equation  (2-53)  is  zero  since 
T  T 

E{vt  (t)}  ■  _0  .  Substituting  in  the  augmented  matrices,  the  remaining 

terms  are 


p* ,  <*»  - E  7*.(t’T) 

at  t 

o 


G 

t  cy 


^(x)  vfc  (t)dx 


f  *a<t,T) 


G  B  G  w  Or) 
t  t  cz  ~t 


0  Bcz  Ut(T> 


vtA(t)dx  (2-54 


which  can  be  rewritten  as 


Pvt(t) "  B{r*<t,T> 


BG 
t  cy 


^(T)  ^  (t)dx 


l 


5A(T>  +  BtGcA(T) 


BcA<T> 


v*  (t)dt| (2-55) 


Again,  the  first  term  is  zero  since  v^t)  is  zero-mean,  and  y^(x)  is 


deterministic.  This  leaves 


P*v  (t>  ■  */♦ a(t'T) 


WT)  +  VcAW 


BcA(t) 


vt  (t)dT 


(2-56 


Noting  that  w  (x)  and  v  (t)  are  assumed  independent  and 


E{v(t)v^  (t)}  -  R  6 (t-x ) 

- t  — t  t 


(2-57 


the  expected  value  operation  can  be  moved  Inside  the  integral,  and 
Equation  (2-56)  further  reduces  to 


B  G 
t  cz 

P  ft)  -  T  <p  (t  T)  R  (S(t-T)dT 

at  Jt  * 

°  B 

cz 


(2-58) 


Applying  the  Dirac  delta  sifting  property  to  the  above  equation,  noting 
that  t  is  the  upper  limit  of  the  integration  and  that  it  also  appears 
in  the  delta  function  argument,  yields 


BG 
t  cz 


P  (t)  - 
a  t 


4>a(t,t) 


1  \ 


(2-59) 


The  state  transition  matrix  tb  (t,t)  is  the  identity  matrix  I.  The  value 

a 

of  appears  when  integrating  the  Dirac  delta  function  between  the  time 
limits  to  and  t  since  its  argument  goes  to  zero  at  x*  t,  i.e.,  at  its 


upper  limit.  The  resulting  form  is 


At  this  point,  all  quantities  needed  to  obtain  the  performance 


analysis  for  a  linear,  time-invariant,  continuous-time  system  and 
controller  have  been  defined  in  this  section.  The  primary  result  is  that 
for  a  truth  model  given  by  Equations  (2-17)  and  (2-24)  and  a  controller 
of  the  form  (2-25)  and  (2-26),  the  statistics  of  desired  outputs  are 
given  by  (2-47)  and  (2-48),  using  (2-42)  through  (2-45)  and  (2-60). 


2.4  Improving  Robustness  in  Continuous-Time  Controllers 


The  stability  robustness  of  LQG  controllers  is  guaranteed  assuming 
that  full-state  feedback  is  available.  However,  once  a  Kalman  filter  is 
inserted  into  the  loop,  all  guarantees  of  robustness,  such  as  minimum 
gain  and  phase  margins,  are  lost  (Ref  6).  J.C.  Doyle  demonstrated  this 
for  a  simple  case  of  an  observer-based  controller  in  Reference  5. 

In  Reference  6,  Doyle  and  Stein  introduced  a  method  for  improving 
the  robustness  of  a  control  system  that  employs  an  observer  or  state 
estimator  to  generate  estimates  of  states  when  full-state  feedback  is 
unavailable.  In  many  practical  systems,  this  is  the  case.  Their  method 
assumes  that  the  linear,  time-invariant  system  to  be  controlled  is 
observable,  controllable  and  has  no  transmission  zeros  in  the  right-half 
s-plane,  (i.e.,  it  is  minimum  phase). 

Figure  (2-3)  shows  the  structures  for  a  full-state  feedback  control 
ler  and  an  observer-based  controller.  Doyle  and  Stein  claim  that  if 


Controller 


Che  corresponding  return-difference  mappings  are  asymptotically  equal 
when  the  control  loops  are  broken  at  point  x  (the  point  of  entry  of  the 
control  inputs),  then  the  robustness  properties  cf  the  observer-based 
controller  will  asymptotically  approach  those  of  the  full-state  feedback 
controller. 

The  return-difference  mappings  of  Figure  (2-3)  are  equal  if  the 
observer  satisfies  the  following  equation 


K  I  +  H(sI-F)“1k]  -  b[h(sI-F)~1b]~1 


(2-61) 


where  H,F,  and  B  are  system  matrices  and  K  is  the  observer  gain.  Let  K 
be  parameterized  as  a  function  of  the  scalar  variable,  q.  Equation 
(2-61)  is  satisfied  asymptotically  as  q  approaches  infinity  if 


- >  BW 


(2-62) 


where  W  is  any  nonsingular  matrix.  If  the  observer  used  is  Kalman 
filter,  then  K(q)  becomes  the  Kalman  filter  gain 


K(q)  -  P(q)HTR~ 1 


(2-63) 


and  P(q)  replaces  in  Equation  (2-16). 

,  T 

To  implement  the  Doyle  and  Stein  technique,  the  value  of  GQG  in 

T 

Equation  (2-16)  must  be  altered.  Let  Qq  be  the  matrix  GQG  of  the 
original  system  (i.e.,  let  G  ■  I)  and  0(q)  be  the  modified  matrix  after 
the  robustif ication  technique  is  applied.  The  modified  matrix  is 


Q(q)  -  +  q2BVBT 


(2-64) 


U1 


where  q  is  the  design  parameter  chosen  to  reflect  the  amount  of  desired 
robust if icat ion  and  V  is  a  positive  definite  symmetric  matrix.  Note  that 
the  second  term  of  Equation  (2-64)  implies  adding  additional  pseudonoise 
to  the  system  at  the  point  of  entry  of  the  control  inputs,  u(t) ,  rather 
than  the  point  of  entry  of  the  dynamic  driving  noise,  w(t) .  As  q 
approaches  infinity,  the  observer-based  controller  recovers  the  robust¬ 
ness  properties  of  a  full-state  feedback  controller.  Note  that  if  q  is 

T 

zero,  Q(q)  is  the  GQG  matrix  of  the  original  system. 


2.5  Sampled-Data  Controller 

For  a  continuous-time  system,  represented  by  Equation  (2-1),  having 
sampled-data  measurements,  an  equivalent  discrete-time  stochastic  dif¬ 
ference  equation  (Ref  23:170)  can  be  written  as 


-(ti+l>  "  *(ttU*l»ti)  -(ti}  +  Bd(ti)  ^(ti)  +  Gd(ti)  ^(ti}  (2-65) 


where  w.(t.)  is  a  discrete-time  white  Gaussian  noise  with  statistics 
— a  X 


E{wd(t1)}  -  0 


E{Wd(ti)  Wjj  "  Qd^i^ij 


(2-66a) 

(2-66b) 


and  6^  is  the  Kronecker  delta,  equal  to  one  if  i«j  and  zero  if  if4  j . 


The  matrix  (JKt^.t^  is  the  state  transition  matrix  for  the  system 
over  a  single  sample  period  and  B^tj)  an<*  ^d^Ci^  are  defined  in  terms 
of  the  continuous- time  system  matrices  to  be 


(2-67) 
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Qjltj)  J  <^ti+l,T'  G  ^  ^ti+l’T)dx  (2-68 


Note  that  Equation  (2-67)  inherently  assumes  u(t)  is  held  constant  over 

a  sample  period,  i.e.,  u(t)  -  u(t^)  for  all  t^  in  the  interval 

[t. ,t. G,(t.)  is  defined  to  be  an  identity  matrix  I.  If,  as  in 
i  1+1  a  1 

the  continuous-time  controller  case,  a  time  invariant  system  model  and 
stationary  noises  are  assumed,  and  if  in  addition  a  fixed  sample  period 
is  assumed,  the  integrations  of  Equation  (2-67)  and  (2-68)  need  only  be 
performed  once  and  and  are  constant  matrices. 

A  discrete-time  cost  function  similar  to  that  of  Equation  (2-3)  can 


be  generated  as 


Jc"E  2  -  (tn+l*  Xf  -(tn+l) 


+  Z  I 

i-0  1 


x^) 


u(t±) 


x(t1)  s(tt)  x(t±) 


SL(t±)  U(t1)J[u(ti)J 


In  the  above  equation,  tfl  is  the  last  time  at  which  a  control  is 
applied.  It  is  assumed  that  a  zero-order-hold  is  used  to  Interface  with 
the  continuous- time  system.  Xf  and  X(t^  are  positive  semi-definite 
weighting  matrices  and  U(ti)  is  a  positive  definite  weighting  matrix. 
S(ti)  is  chosen  so  that  the  composite  matrix  of  Equation  (2-69)  is 
positive  semi-definite.  The  weighting  matrices  are  again  assumed 
constant  henceforth,  in  order  to  obtain  constant  gain  control  laws 
eventually. 


The  LQ  optimal  full-state  feedback  control  law  is  given  by 

u*(t±)  -  -Gc*(ti)  x(tt)  (2-70) 

* 

where  G£  (t^)  is  the  solution  to  the  equation 

Gc*(ti)  •  1D  +  “dT  Kc(tl+1>  V'‘  t‘dT  Kc(tl+1>  *  +  '*1  <2-"> 

and  ^c(t^)  satisfies  the  backward  recursive  Riccati  difference  quatlon 

T 

W  "  X  +  *TKc(ti+l) * •  [BdTKc(ti+l)  *  +  sT]  Gc*(ti)  (2~72) 
subject  to  the  final  condition 

VW  ’  xf  «-«> 

As  in  the  case  of  a  continuous- time  system  having  continuous-time 
measurements,  perfect  access  to  all  the  states  usually  is  not  available. 
Instead,  sampled-data  measurements  may  be  available  in  the  form  of 

zCtj)  -  H  xUj)  +  v^tj)  (2-74) 

where  v^(t^)  is  a  discrete-time  white  Gaussian  noise  assumed  independent 
of  dynamics  driving  noise  w^t^)  in  Equation  (2-65),  with  statistics 

E  (Vj^)}  -  0  (2-75a) 


Again,  a  Kalman  filter  is  employed  to  generate  an  estimate  of  the 


conditional  mean,  jc(tj+),  and  conditional  covariance,  P ( t ),  of  the 
states  of  the  system. 

The  mean  and  covariance  are  propagated  between  sampled  times  by 
these  equations  (Ref  23:217) 

x(ti+“)  -  (frxCt^)  +  Bdu(ti)  (2-76a) 

P(ti+1)  *  **<0  ^  +  Gd  Qd  GdT  (2-76b) 

Then,  at  the  sample  times  when  measurements  are  taken,  the  mean  and 
covariance  are  updated  by  (Ref  23:217) 

x(t±+)  -  x^')  +  K(ti)  [z^)  -  H  x(ti-)]  (2-77) 

P(ti4‘)  -  P(ti”)  -  K(t±)H  P(t±~)  (2-78) 

where  K(tj)  is  the  Kalman  filter  gain,  given  by 

K(ti)  -  P(ti")  HT[H  P(t±‘)  HT  +  Rd]_1  (2-79) 

The  superscripts,  -  and  +,  refer  to  quantities  just  before  and  just 
after  the  measurements  at  the  samples  times  are  taken,  respectively. 

The  mean  and  covariance  are  propagated  and  updated  forward  in  time 
by  the  above  discrete-time  Kalman  filter  equations  subject  to  the 


initial  conditions 


which  are  obtained  from  an  a  priori  Gaussian  density  function  of  the 
states  at  the  initial  time,  as  discussed  below  Equation  (2-13). 

As  in  the  continuous-measurement  case,  it  is  desired  to  generate 
a  constant-gain,  steady-state  LQG  controller.  Thus,  steady-state  solutions 
from  Equations  (2-72) ,  (2-76b)  and  (2-78)  are  desired  to  generate  a 

constant  Kalman  filter  gain  matrix,  K,  and  a  constant  feedback  gain  matrix, 

* 

G  . 
c 

The  form  of  the  sampled-data  controller  is  shown  in  Figure  (2-4) . 

2.6  Sampled-Data  Performance  Analysis 

The  performance  analysis  for  a  sampled-data  LQG  controller  is  based 
on  the  development  in  Reference  24:Ch  14. 

Similar  to  Section  2.3,  a  truth  model  for  a  given  system  is  developed 
which  has  the  following  form 

x^t)  -  Ft  x^t)  +  Bt  u(t)  +  Gt  wjt)  (2-81a) 

•  Ht  W  +  (2_81b) 

The  measurements  are  now  in  sampled-data  form,  and  v,.  (t.)  is  a  discrete 

“tit  1 

time  white  Gaussian  noise  of  covariance  R^ . 

As  shown  in  Figure  (2-5) ,  proposed  sampled-data  controllers  can  be 
inserted  into  the  truth  model  simulation  of  the  real  world  and  their 


performance  evaluated. 


V£i: 


*t<ei> 


Controller 


u(t.) 


u(t._) 


..J 


Figure  2-5:  Performance  Evaluation  for  Linear 
Saopled-Data  Controller 

For  each  controller.  It  Is  desired  to  evaluate  a  control  law  of  the 
generic  form 


uUj) 


G  x  (t.)  +  G 
cx  -c  * 


r  ■  ~cz  -ri 


W  +  Gcy*d(ti> 


(2-82) 


where  _u(t^)  uses  measurements  up  to  and  Including  the  1th  measurement  and 
Is  held  constant  over  the  1th  sample  period.  The  states  of  the  controller 
can  be  propagated  by  the  linear  difference  equation 

Se(ti+1>  -  ♦A'V  +  Bc*  5t(ti>  *  Bcy  *4(tl>  <2'83) 

Note  Che  analogous  form  of  the  above  two  equation  to  that  of  Equation 
(2-25)  and  (2-26).  Expressions  for  the  gains  multiplying  (t^) , 
z^t^)  and  are  given  in  Appendix  A.  Initial  conditions  for  the 

controller  states  are  usually  assumed  zero. 

The  performance  of  a  controller  is  evaluated  by  generating  time 
histories  of  the  mean  and  covariance  of  the  augmented  Gaussian  vector 


7. 


LLaiaf.^'A  .  *  .  •  . 
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and  the  corresponding  vector  between  sample  times.  This  is  developed 
subsequent  to  a  description  pertaining  to  sample  times  only. 

First,  as  in  Section  2.4,  it  is  necessary  to  evaluate  the  statistics 
of  a  second  augmented  vector 

(2-85) 

By  performing  the  integrations  indicated  in  Equations  (2-67)  and  (2-68) , 
an  equivalent  discrete-time  equation  can  be  generated  for  Equation 
(2-81a).  Then  by  substituting  Equations  (2-81b)  and  (2-82)  into  the 
equations  for  the  truth  model  and  controller  states.  Equations  (2-81a) 
and  (2-83)  can  be  rewritten  as 


i > 


W 


)  -  [*t  +  »dt0„Ht]  ^(tj) 


+  Bdt°cA(V  +  “dtVd<ti) 


+  1  2dt<et>  +  Bdt°c*  2dt<ti> 


(2-86) 


2c<ti+l)  +  +  B«Ht  2t(ei> 


+  Bcy  *d(tl>  +  Bcz  ^dJV 


(2-87) 


The  subscript  d  referes  to  a  discrete  quantity. 

Form  the  augmented,  stationary,  zero-mean  white  Gaussian  noise 


vector 


with  covariance 


2dc(tl> 


«dt  0 


If  w,_(t.)  and  v..(t.)  are  correlated  when  off-diagonal  terms  can  be 
— dt  I  — at  i 

added  to  Equation  (2-89). 

Now  an  augmented  system  equation  can  be  written  by  combining 
Equations  (2-86)  and  (2-87) 


VW  ‘  +  “da  W  +  °da  2da(tl> 


where 


+  B,  G  H  B,  G 
dt  cz  t  dt  cx 


The  initial  conditions  for  the  augmented  system  are  given  by 


E{x(t  )} 
—a  o 


(2-94) 


E{[x  (t)  -  xl[x  (t  )  -  S  T]} 
—a  o  — ao  —a  o  - ao 


(2-95) 


If  desired,  a  cost  function  for  the  augmented  system  can  be  formed, 
as  shown  in  References  24:Ch  14; 12.  . 


The  mean  and  covariance  of  the  augmented  vector,  x  (t.)  can  be 

— a  l 


propagated  by 


2*  (ti>  ‘  (ti>  +  Bda  W 

a  a 


(2-96) 


P,  x  (tl>  -  *aP*  *  *  +  Wda 

a  a  a  a  a 


(2-97) 


The  vector  of  interest,  j^(tj) ,  is  related  to  x^t^)  by  the 


following  equation 


35 


+ 


w + 


(2-98 


G 

cy 


G 

cz 


and  the  desired  statistics  are  therefore  generated  by 
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cz  t 

G 

cx 
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cy 
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Va  1 

P  (t.) 

x  x  i 
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G  H 
cz  t 
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cx 

G  H  G 

CZ  u  cxj 

(2-99) 


+ 


T  , 
G 

cz 


(2-100) 


Equations  (2-99)  and  (2-100)  provide  an  efficient  means  for  evaluating 
statistics  at  the  sample  times  via  the  equivalent  discrete-time  system 
model.  However,  it  may  be  desired  to  obtain  more  complete  results 
between  sample  times,  to  ensure  that  adequate  sample  period  choice  and 


system  control  have  been  achieved.  Between  sample  instants,  a 
differential  equation  for  £a(t)  can  be  written  as 


F  B 

G 

t  t 

t 

m 

2  (t)  + 
■^a 

0  0 

0 

WfcU) 


(2-10i; 


and  the  mean  and  covariance  can  be  propagated  from  ^  to  t^+^ ,  where 
u(t^)  undergoes  a  step  change,  using  the  initial  conditions  given  by 
Equations  (2-90)  and  (2-91).  The  propagation  equations  are 
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At  this  point,  all  quantities  of  interest  have  been  defined  to 
evaluate  the  performance  of  a  sampled-data  controller.  The  primary 
results  are  that  for  a  truth  model  given  by  (2-81)  and  a  controller  of 
the  form  (2-82)  and  (2-83),  the  statistics  of  desired  outputs  at  the 
sample  times  are  given  by  (2-99)  and  (2-100) .  Between  sample  times  the 
statistics  are  given  by  (2-102)  and  (2-103). 


2.7  Improving  Robustness  in  Discrete-Time  Systems 


Three  approaches  are  taken  to  apply  the  robustif ication  technique 
described  in  Section  2.3  to  sampled-data  controllers.  The  first  is 
simply  to  discretize  the  LQG  controller  designed  for  the  continuous- time, 
continuous-measurement  system.  The  second  approach  is  to  extend  the 
technique  of  adding  pseudonoise  to  the  points  of  entry  of  u  to  a  sampled- 
data  system  by  making  a  first  order  (or  better)  approximation  to  the 
modified  Q  matrix.  The  third  is  to  apply  the  fundamental  conditions 
under  which  full-state  feedback  characteristics  are  obtained  asymptotic¬ 
ally  from  a  controller  with  a  filter  or  observer  in  the  loop. 

It  has  been  observed  in  Reference  21  that,  unlike  the  continuous- 
measurement  case,  the  scalar  parameter  q  of  Equation  (2-64)  cannot  be 
adjusted  arbitrarily  upwards  for  the  discrete-time  case.  Rather,  there 
is  a  finite  range  of  values  for  q  that  will  robustify  the  Kalman  filter, 
and  beyond  that  range  the  closed- loop  system  is  unstable. 


2.7.1  Discretizing  the  Continuous-Time  LQG  Controller 

The  required  format  for  the  discretized  controller  is  given  by 

Equation  (2-82)  which  requires  values  for  G  (t  ) ,  G  (t  )  and  G  (t  ) , 

cx  x  cz  x  cy  x 

and  by  Equation  (2-83)  which  requires  values  for  $  (tj_^,tj) ,  Bcz(ti) 

and  B  (tj.  Recall  that  the  continuous-time  controller  equations  are 
cy  i 

expressed  as 


u(t)  -  Gcx(t)  x^t)  +  Gcx(t)  z(t)  +  G  (t)  ^(t)  (2-104) 


x^t)  -  Fc(t)  x^t)  +  Bcz(t)  z(t)  +  Bcy(t)  ^(t)  (2-105) 


In  Appendix  A,  it  is  shown  that  for  a  steady-state  constant-gain  LQG 
regulator 
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B  (t)  -  0  (2-106f) 
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For  this  problem,  G  (t)  is  a  constant  value  G  ,  and  thus  the 

c  c 

discretized  control  law  is  given  by 

u(t  )  -  -G*  x  (t.)  (2-107) 

—  i  c  — c  l 

To  obtain  a  discrete  propagation  equation  for  the  controller  states 
first-order  approximations  for  $c(ti+j,tj),  Bcz(ti)  and  are 

obtained  by 

♦c^i+rV  "  [I  +  Fc(ti)At]  (2-I08a) 


Bczd(ti>  "  Bcz(ti)At 


(2-108b) 


Again,  for  this  thesis,  the  system  Is  assumed  time  Invariant  and  F^, 

Bcz»  and  B  are  constant  matrices.  They  are  evaluated  explicitly  in 
Appendix  A.  The  quantity  At  is  the  sample  period  for  the  sampled-data 
system.  Higher  order  approximations  are  also  possible,  but  if  At  is 
not  sufficiently  small  compared  to  the  transient  times  of  the  system, 
this  basic  idea  breaks  down  anyway,  so  its  use  is  confined  to  problems 
with  short  sample  periods 

In  addition,  a  discrete  approximation  for  R^t(t^)  is  needed  for  use 

in  the  performance  analysis  described  in  Section  2.6.  If  the  sample 

time  is  sufficiently  small  to  allow  the  approximations  in  Equation 

(2-108) ,  then  it  is  reasonable  to  make  a  first-order  approximation  for 

the  discrete  measurement  noise  covariance  RJk(t.).  This  is  given  by 

dt  l 

Rdt(ti)  "  WMt  (2-109) 

Notice  that  as  At  — >  0,  the  discrete-time  white  noise  (t^)  of 
Equation  (2-81b)  converges  to  the  continuous-time  white  noise  described 
by  (2-18)  and  (24)  if  (2-109)  is  satisfied  throughout  the  limiting 
process . 

2.7.2  Doyle  and  Stein  Technique  for  Sampled-Data  Systems 

The  second  approach  to  enhancing  robustness  is  to  extend  the  Doyle 
and  Stein  technique  and  apply  it  directly  to  a  sampled-data  controller. 
Several  ways  of  accomplishing  this  are  considered. 

If  the  sampled  period  of  the  system  is  sufficiently  small,  a  first- 
order  approximation  for  the  discrete-time  noise  strength  matrix  Qd(q), 


can  be  made  which  is  the  discrete  counterpart  for  Equation  (2-64). 

This  yields 

Qd(q)  +  Qdo  +  q2  BVBT  At  (2-110) 

where  Qdo  is 

Qd0  ■  Qd(t±)  (2-111) 

which  is  defined  in  Equation  (2-68).  Again,  this  implies  that  Gd  ■  I. 

For  larger  sample  times,  a  first-order  approximation  may  not  be 
sufficient.  If  this  is  the  case,  sublntervalling  may  be  considered  a 
higher  order  approximation  for  Q^(q) ,  such  as 

Qd(q)  -  |  t<J>Q(q)  +  Q(q)4>T]  At  (2-112) 

as  given  in  Reference  24:172. 

Another  alternative  is  to  make  the  return-difference  mapping  for  the 
observer-based  controller  asympotically  equal  to  that  of  the  full-state 
feedback  controller  in  the  discrete-time  case.  The  two  configurations 
are  shown  in  Figure  (2-6) .  The  observer-based  system  is  based  upon  the 
sub-optimal  control  law 

u(t±)  -  -Gc*  x(tt“)  (2-113) 

A  ^ 

rather  than  the  law  given  by  Section  2.5  using  x(t^  ). 

To  recover  the  robustness  properties  of  the  full-state  feedback 
system,  [$K]  must  be  found  such  that 

$K[I  +  H(zl  -  -  B, [H  (zl  -  4>)_1  B.] 


(2-114) 


Controller 


Figure  2-6a: 


Controller 
Figure  2 


Full-State  Feedback  System 


b:  Observer-Based  Feedback  System 
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where  the  analysis  is  carried  out  in  the  z-domain.  Equation  (2-114)  is 
satisfied  asymptotically  when  the  Kalman  filter  gain,  K,  is  parameterized 
as  K(q) ,  and 


£!>.  ^  -  Sd  “  <2-115) 

where  W  is  a  nonsingular  m  x  m  matrix.  Therefore,  for  finite  values  of 
q,  K  is  given  by 

K  -  q$-1  Bd  W  (2-116) 

Unfortunately,  this  does  not  lend  itself  to  an  interpretation  of 
retuning  via  pseudonoise  addition,  as  in  the  continuous-time  case. 

Reference  24:113-114  suggests  looking  at  the  dual  state  equations 
to  select  W.  This  yields 

W  -  [H  <f 1  Bd]"1  (2-117) 

which  assigns  m  eigenvalues  of  the  closed  loop  dual  system  to  the  origin 
and  the  remaining  (n-m)  eigenvalues  to  the  invariant  zeros  of  the  system 
where  n  is  the  number  of  states  and  m  is  the  number  of  controls. 

To  use  the  performance  analysis  equations,  the  sub-optimal  control 
must  be  put  into  the  generic  format  of  Equations  (2-82)  and  (2-83) . 

This  is  shown  explicitly  in  Appendix  A. 

2.8  Summary 

The  preceding  sections  have  presented  the  equations  for  designing 
and  evaluating  optimal  LQG  regulators.  Three  applications  are  considered: 
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a  continuous-time  controller,  a  discretized  continuous-time  controller 
and  a  sampled-data  controller.  The  structure  of  these  controllers  was 
examined  with  and  without  a  Kalman  filter  in  the  loop  to  estimate  states. 

For  the  case  where  a  Kalman  filter  is  necessary  to  estimate  states, 
a  technique  was  presented  to  robustify  a  controlled  system  against 
differences  that  exist  between  the  controller  design  model  and  the  real 
world  system.  The  technique  was  developed  for  a  continuous-time  system 
and  several  extensions  to  discrete-time  systems  were  presented. 

A  disadvantage  of  the  type  of  controller  considered  in  this  chapter 
is  that  it  will  not  regulate  the  states  to  zero  in  the  face  of  unmodeled 
disturbances.  Also,  it  only  regulates  the  deviations  in  the  states  from 
an  equilibrium  position  and  does  not  allow  the  system  to  track  a  desired 
piecewise  constant  non-zero  input.  Chpater  III  presents  the  development 
for  a  type  of  controller  that  does  exhibit  these  characteristics,  based 
on  an  LQG  methodology. 
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III.  PI  CONTROLLERS 


3. 1  Introduction 

This  chapter  presents  the  equations  used  for  designing  Proportional- 
plus-integral  (PI)  controllers  for  a  system  modeled  as  linear,  time- 
invariant,  and  driven  by  stationary  white  Gaussian  noise  and  determin¬ 
istic  inputs.  The  model  used  for  this  thesis  is  described  in  Chapter  V. 

The  advantage  of  a  PI  controller  over  the  regulator  described  in 
Chpater  II  is  that,  in  the  absence  of  stochastic  inputs,  it  will  maintain 
the  system  output  at  some  nonzero  commanded  value  with  zero  steadystate 
error,  even  in  the  presence  of  unmodeled  constant  disturbances.  This  is 
known  as  a  "Type-1"  property  (Ref  4) .  This  property  is  achieved  by 
integration  of  the  error  in  the  controlled  variables,  i.e.,  integration  of 
the  difference  between  achieved  and  desired  values  of  the  controlled 
variables.  In  discrete-time  feedback  control,  the  PI  effect  is  achieved 
by  performing  summation  (or  pseudo- integration,  often  interpreted  as 
Euler  integration)  on  either  the  difference  between  the  actual  and  desired 
system  outputs  (regulation  error).  In  this  thesis,  this  structure  is 
obtained  via  LQG  synthesis  applied  to  an  augmented  system  composed  of  the 
original  system  states  and  the  controls  (Ref  24:141-150).  Two  possible 
implementations  are  "position  form"  and  "incremental  form".  In  position 
form,  the  control  u(t^)  is  specified  in  terms  of  the  current  position  of 
the  system  state,  x(tj),  as  in  the  LQ  regulator  solution  of  the  previous 
chapter.  In  incremental  form,  only  changes  in  states  and  commands  from 
the  previous  values  are  used  to  generate  increments  in  control  relative  to 
the  value  at  the  previous  sample  time.  For  implemention,  an  incremental 
form  PI  controller  is  generally  preferable  because  it  is  not  necessary 
to  provide  initial 


values  for  the  controller  states  as  in  the  position  form.  Also  it  lends 
iteself  more  readily  to  relinearizations  about  new  nominal  values  and  to 
anti-windup  compensation  (Ref  24). 

The  optimal  deterministic  (LQ)  PI  controller  is  developed  in  the 
first  section  of  this  chapter  for  a  sampled-data  system.  Next,  the 
Doyle  and  Stein  technique  is  applied  to  a  PI  controller.  Then  the 
controller  is  put  into  the  generic  format  presented  in  Chapter  II,  with 
a  Kalman  filter  in  the  loop  to  provide  estimates  of  the  states  to  the 
controller.  Once  the  generic  form  is  available,  the  performance  of  the 
controller  may  be  evaluated  using  the  method  of  the  previous  chapter. 

The  software  developed  to  design  optimal  PI  controllers  is  described 
in  Reference  13.  Modifications  to  the  software  are  described  in  References 
26,  27  and  29.  The  performance  analysis  software  is  described  in 
Reference  29.  The  above  references  deal  primarily  with  the  design  of 
controllers  that  employ  a  PI  regulator  in  the  inner  feedback  loop  and  a 
Command  Generator  Tracker  (CGT)  to  provide  inputs  to  the  system  (Ref  12). 
This  chapter  contains  the  development  of  only  the  inner  loop  PI  regulator. 

3.2  Sampled-Data  PI  controller 

The  following  development  for  a  PI  controller,  based  on  augmentation 
to  the  original  system  state  relations  of  equations  for  pseudo- integration 
of  the  control  input  rates,  is  found  in  Reference  24:Ch  14. 

3.2.1  Control-Rate  Pseudo  Integration 

Recall  from  Chapter  II  that  an  equivalent  discrete-time  difference 
equation  can  be  generated  for  the  continuous-time  system  model  in  the 


-(*1+1)  “  +  Bd  — (3-1) 

where,  by  the  certainty  equivalence  principle  (Ref  24:Ch  13),  the  noise 
vector  was  deleted. 

Define  the  perturbation  state  and  control  variables  to  be 

5x(t.)  -  x(t.)  -  x  (3-2a) 

—  l  —  l  — o 


6u(ti)  -  u(tt)  - 


(3-2b) 


where  x  and  u  are  the  nominal  values  of  the  states  and  the  controls  to 
— o  — o 

maintain  the  system  at  its  equilibrium  "trim"  operating  condition  such 
that  controlled  variables  assume  the  desired  values.  If  an  equation  for 
the  output  of  the  system  is  given  by 

Z<t±)  -  Cx(t1)  +  Dy  u(ti)  (3-3) 

then  the  nominal  control,  u  ,  to  hold  the  system  at  that  equilibrium 

— o 

operating  point  is  found  as  the  solution  to 

x  ■  $x  +  B ,  u  (3-4a) 

— o  — o  d  — o 
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where  ^  i*  the  desired  system  output.  Then,  (3-5)  can  be  solved  as 
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The  difference  in  perturbation  control  variable  is 


Mti+1>  -  "  JjJ  -  ~  Hq! 


or,  equivalently 


<5u(ti+1)  -  6u(t^)  +  [u(ti+1)  -  uCt^]  (3- 

The  above  equation  has  the  form  of  an  update  relation  for  6u(ti+1).  I 
the  second  term  is  thought  of  as  an  Euler  integration  of  the  time  rate 
of-change  of  the  control  input  vi  at  time  t^,  then  the  change  in  u,  i.e 
the  bracketed  term  in  Equation  (3-9) ,  can  be  written  as 

Au(ti)  “[u(t1+1)  -  va(t±)J  -  uU^At  (3- 

where  At  is  the  sample  time  of  the  controller.  Thus,  Au(t^)  is  termed 
the  control  pseudo-rate  and  Equation  (3-9)  becomes 


Su(ti+1)  *  Su^)  +  Au(t±) 


At  this  point,  an  augmented  state  description  can  be  written  using 
Equations  (3-1)  and  (3-11)  for  the  perturbation  variables  6x(t.)  and 


The  optimal  regulator  solution  described  In  Section  2.5  can  now  be 


applied  to  the  augmented  system  above,  subject  to  a  quadratic  cost 
criterion 


T 

Xf  0  . 

0  0 

,  N 

6x(ti) 

T 

xn 

X12 

S1 

6x(ti) 

+  \  2 

2  i— 1 

5u(ti) 

*12T 

X22 

S2 

(SuCt^ 

Au(ti) 

.V 

S2T 

U 

Au(t±) 

where  X^  places  a  weighting  on  state  deviations  away  from  the  nominal 
X^2  places  a  weighting  on  control  deviations  away  from  u^,  and  U 
places  a  weighting  on  the  control  pseudo-rates,  Au(t^).  Notice  that  this 
term  allows  the  designer  to  place  a  weighting  on  the  rate  of  change  of 
control  inputs,  i.e.,  to  guard  against  commanding  actuator  rates  that  are 
beyond  the  physical  limits  of  the  actuators. 


The  term  applies  a  weighting  on  deviations  of  the  states  at  the 


final  time.  The  cross-terms  X^»  and  S£  arise  as  the  continuous¬ 


time  cost  is  converted  to  a  discrete-time  cost,  as  demonstrated  in 


Reference  24  and  12.  In  Equation  (3-13),  notice  that  the  index  for  the 


summation  begins  at  -1.  This  places  a  weighting  on  the  potentially 


large  control  differences  which  may  occur  at  the  initial  time  due  to  a 


change  in  the  setpoint  (Ref  24:142). 


To  apply  the  optimal  regulator  solution  to  Equations  (3-12)  and 


(3-13) ,  redefine  the  matrices  as  follows 


4 


(3-14) 


(3-15) 


(3-16) 


(3-17) 
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Kc(ti>  -  XS  +  »ST  Kc<W  1*6  -  B6  O  -  S«C  <3'24) 


solved  backwards  from  the  terminal  condition 


Kc(tN+l)  “  Xf6 


(3-25) 


The  optimal  control  input  is  given  by  Equation  (3-22)  in  partitioned  form 


Au*(t  )  -  -  G  *  6x(t . )  -  G  *  <Su(t.)  (3-26) 

l  c^  —  i  c.^  —  i 


Combining  this  with  Equation  (3-11)  yields 


<S*‘W  ■  **<«!>  -  »«,* 


5x(ti) 


6u*(t±) 


(3-27) 


Unfortunately,  the  above  control  law  does  not  achieve  the  desired  Type 
1  property. 


3.3  Achieving  Type-1  Control 

The  desired  integral  characteristics  for  the  controller  can  be 
achieved  by  manipulation  into  the  form  of  a  continuous- time  PI  controller 


(Ref  1) 


u*(t)  -  -K^x(t)  +  Kz  J  [jTj  -  £00]  dx  (3-28) 


where  is  the  desired  output  and  £(t)  is  the  actual  system  output  defined 


£(t)  -  Cx(t)  +  DyU(t) 


(3-29) 
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A  discrete-time  equivalent  is  given  by 


i-1 


u  (t±)  -  -K^c(ti)  +  Kz  Z  ^  -jr(tj)] 


In  incremental  form,  the  above  equation  is  expressed  as 


u  (ti+1)  ■  u  (t1)  -Kx[x(ti+1)  -  x(t±)]  +  “  £<^>1 


Define  a  perturbation  output  equation  as 


6l(ti)  -  £(t±)  ~  Id  m  + 


and  the  control  law  as 


<Su  (ti+1)  ■  6u  (t±)  -  Kx[6x(ti+1)  -  6x(t±)] 


Eft 


-  K  [C4x(t,>  +  D 6u(t  )] 
z  —  i  y  i 


The  above  equation  can  be  rewritten  using  Equation  (3-9)  as 


«u*(t1+1)  -  6u* (t±)  -  [Kx  Kz] 


(4>-D  Bd 
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Equating  Equations  (3-34)  and  (3-27) ,  it  is  seen  that 


[K  K  ]  -  [G  *  G  *] 
x  z  ^1  c2 


(4>-I)  Bd 
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(3-30) 


(3-31) 


(3-32) 


(3-33) 


(3-34) 


(3-35) 
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The  values  for  the  feedback  gains  K  and  K  are  thus  defined  by 

X  z 

+  "21  «-37a 


Kz  ■  \  ”12  +  Gc2‘  ”22  (3-371 


*  it 

once  G  and  G  are  available  from  the  augmented  state  regulator 
C1  c2 

solution  and  tt^,  ir^,  and  ^2  are  obtained  from  Equation  (3-35) 

and  (3-36).  The  final  form  for  the  PI  cotroller  which  achieves  Type-1 
control,  implemented  in  incremental  form  is 


<$u*(ti+1)  -  6u'(ti)  -  Kx[6x(t1+1)  -  <5x(t^)  ] 


+  Kz  ^Zd(ti+1)  -^ci>] 


(3-38) 


(3-38) 


Notice  that  the  different  time  arguments  on  the  £  terms  are  correct 
(Ref  24:147). 


3.4  Dovle  and  Stein  Technique  for  PI  Controllers 


The  technique  of  injecting  white  input  noise  into  a  controlled 
system  is  accomplished  for  a  sampled-data  PI  controller  in  a  manner 
similar  to  that  described  in  Section  2.7.2  for  a  sampled-data  LQ  regulator. 


>  A  AlvA  .S.VA  A/..  •  .  -j.  * 


The  equivalent  discrete-time,  stochastic  difference  equation  to 
describe  the  system  to  be  controlled  is  given  by 

x(t1+i)  -  (frxCt^  +  Bd  u(t±)  +  Gd  wd(ti)  (3-39) 

where  the  noise  vector  has  now  been  included.  The  discrete-time  input 
vector,  Bd>  and  the  noise  covariance,  Qd,  are  formed  by  solving  the 
following  equations 

Bd  -  /1+14>(ti+1  -T)  B  dT  (3-40) 

t. 

1 

t.. 

Qd  ■  /*%<* i+rT)  ^  *T(ti+1“T)  dT  (3_41) 

fci 

T 

where  Q,  ■  E(w, (t.)w,(t.)}  .  G.  is  now  defined  to  be  the  identify 
d  “u  i  — a  1  a 

matrix,  I. 

Recall  from  Chapter  II  that  input  noise  was  added  to  the  system  by 
modifying  the  Qd  matrix  via 

Qd(q)  "  Qdo  +  l2*™1**  (3-42) 

where  Q ,  is  now  the  original  noise  covariance  given  in  Equation  (3-40) , 
do 

B  is  the  input  vector  from  the  continuous- time  state  differential 
o 

equation,  q  is  a  scalar  design  parameter  which  adjusts  the  strength  of 
the  input  noise,  and  At  is  the  sample  time  of  the  discrete  controller. 
This,  in  effect,  makes  a  first-order  approximation  to  the  discrete-time 
input  noise. 

However,  the  discrete-time  input  vector  is  available  from  Equation 
(3-40)  and  is  approximated  to  first  order  by  B.  *  BAt,  and  so  it  will  be 


used  to  modify  the  Qd  matrix  for  PI  controllers.  The  resulting  modified 
noise  covariance  matrix  is 

V’5  ■  Qdo  +  ^  Bd 7  BdT  /At  (3-43> 

where  V  is  a  nonsingular  matrix,  chosen  to  be  the  identity  matrix  for  this 
thesis.  Notice  that  the  Kalman  filter  design  is  the  same  regardless  of 
the  type  of  controller  implemented  so  that  robust if icat ion  would  be  ac¬ 
complished  in  the  same  manner  as  described  in  Chapter  II.  The  structure 
of  the  sampled-data  PI  controller  is  shown  in  Figure (3-3).  The  Kalman 
filter  of  Figure  (3-1)  is  the  same  as  for  the  LQG  regulator  shown  in 
Figure  (2-4). 

3.5  Performance  Analysis  for  PI  Controllers 

The  performance  analysis  for  a  PI  controller  is  accomplished  by 
following  the  same  procedure  given  in  Section  2.6  for  LQ  regulators.  As 
given  in  Equation  (3-38),  the  incremental  form  for  the  optimal,  determin¬ 
istic  PI  control  law  is  given  by 

<5u*(ti+1)  -  Su*(t1)  -  K^  “  5*(ti)  1 

(3-44) 

+  Kz  [2d(tW  ‘  *(ti)] 


Again,  the  differing  time  arguments  on  the  £  terms  are  correct. 

When  a  Kalman  filter  is  employed  to  estimate  states  for  the 
controller,  the  conditional  mean  and  covariance  of  the  states  are  propa¬ 
gated  between  sample  times  by  Equations  (2-76a)  and  (2-76b) .  At  the 
sample  times,  when  measurements  become  available ,  the  conditional  mean  and 


ad 


covariance  are  updated  by  Equations  (2-77)  and  (2-78),  where  the  Kalman 
filter  gain  is  given  in  Equation  (2-79).  Using  the  control  law  of 
Equation  (3-44)  and  the  Kalman  filter  equations,  the  PI  controller  can 
be  put  into  the  generic  format  introduced  in  Equation  (2-82)  and  (2-83) : 


a  <W  +  Gc*  W  +  Gcz  i<tl)  +  Gcv  2d(tl>  <3-45a> 


VW  *  *c  *c< V  *  Bc*  ^  *  Bcy  W 


(3-45b) 


where  the  subscript  c  refers  to  states  of  the  controller.  The  gain 
matrices  of  Equations  (3-45a)  and  (3-4Sb)  are  evaluated  explicitly  in 


Appendix  A. 

At  this  point,  the  performance  of  the  PI  controller  may  be  evaluated 
using  the  method  of  Section  2.6,  evaluating  the  statistical  characteristics 


of  an  augmented  vector 


W  - 


u(tj) 


(3-46) 


which  is  composed  of  the  states  of  the  truth  model  and  the  controls 
generated  by  the  PI  controller. 


3.6  Summary 

The  chapter  has  presented  the  equations  for  designing  and  evaluating 
PI  controllers  based  on  an  LQG  methodology.  The  advantage  of  a  PI  con¬ 
troller  over  the  LQG  regulator  discussed  in  Chapter  II  is  that  it  will 
track  a  desired  output  with  zero  steady-state  error  (in  a  deterministic 


>si 


setting,  or  in  zero  steady-state  mean  error  in  a  stochastic  environment) 
even  in  the  face  of  unmodeled  constant  disturbance.  The  type  chosen 
for  implementation  was  an  incremental  form  of  PI  controller  that  is  based 
on  augmentation  of  system  state  equations  with  relations  involving  pseu¬ 
dointegration  of  the  control  rates. 

The  Doyle  and  Stein  stability  robustness  enhancement  technique  of 
inputting  white  noise  into  the  system  model  at  the  control  entry  points 
during  filter  tuning  was  applied  to  PI  controllers.  The  following  chapter 
will  extend  this  method  to  allow  time-correlated  input  noise  for  the  case 
where  robustif ication  is  desired  over  only  a  limited  frequency  range. 
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4.1  Introduction 


Section  2.4  introduced  the  idea  of  robustifying  a  Kalman  filter  by 
adding  paeudonoise  to  a  system  at  the  point  of  entry  of  the  control 
inputs ,  u.  By  increasing  the  intensity  of  this  pseudonoise,  the  stability 
robustness  properties  of  a  full-state  feedback  system  could  by  asymptoti¬ 
cally  recovered  by  the  observer-based  sytem. 

One  disadvantage  of  this  techniques  is  that  the  noise  addition  de¬ 
grades  the  performance  of  the  system  at  the  design  conditions.  The  white 
noise  adds  uncertainty  to  the  model  with  the  same  intensity  throughout 
the  frequency  spectrum.  It  may  be  desired  to  robustify  the  Kalman  filter 
only  over  a  certain  frequency  range  where  confidence  in  the  adequacy  of 
the  controller  design  model  may  be  low.  Thus,  a  natural  extension  to  the 
Doyle  and  Stein  technique  (Ref  6)  is  to  add  time-correlated  (colored) 
input  noise  where  the  strength  of  the  noise  is  highest  for  the  frequency 
range  of  interest.  This  chapter  develops  this  idea  and  describes  how  to 
apply  it  to  the  types  of  controllers  discussed  in  Chapter  II  and  III 
(Ref  15;  16;  18). 

In  the  first  section,  a  stochastic  model  is  developed  for  the 
fictitious  colored  noise  process.  Then,  this  is  augmented  with  the  model 
used  to  describe  the  system.  Finally,  the  colored  noise  processes  to  be 
used  in  this  thesis  are  described,  including  the  shaping  filters  to 
generate  them. 

4.2  Stochastic  Model 

Stationary,  time-correlated  input  noise  is  represented  as  the 


steady-state  output  of  a  linear  time- invariant  system  driven  by  white 
Gaussian  noise  as 
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Xy(t)  -  Fu  x^Ct)  +  Gu  w^t) 


(4-la) 


£u(t)  "  Hu  5u(t)  *  Du  Hu(t) 


(4- lb) 


The  subscript  u  refers  to  uncertainty  parameters.  The  statistics  of  the 
stationary  white  noise,  w^t),  are  given  by 


E{w  (t»  -  0 


(4-2a) 


Mj^Ct)  ^  (t+-t)}  -  QySCt) 


(4-2b) 


The  colored  noise  process,  n  (t),  is  added  to  the  system  model. 


given  by 


x(t)  »  F  x(t)  +  B  u(t)  +  G  w(t) 


(4-3a) 


*(t)  r-  A  x(t)  +  v(t) 


(4-3b) 


at  the  point  of  entry  of  jj.  This  results  in 


i(t)  ■  F  x(t)  +  b| u_( t )  +  n^t)  ]  +  G  w^(t) 


(4-4) 


Define  an  augmented  vector  to  be  the  system  states  and  the  uncertainty 

model  states 


x_(t)  ■ 


(4-5) 


*u(t) 


Next,  augment  the  uncertainty  state  differential  equations  with  those 
of  the  original  system.  This  yields  an  augmented  system  equation,  given 
by 


&  (t)  -  F  x  (t)  +  B  u(t)  +  G.  w  (t) 

—6  S  —B  s  —  s  — e 


(4-6a) 


z(t)  ”  H  x  (t)  +  v(t) 

— S  S  —6  — 

The  above  matrices  are  described  by 


(4-6b) 


(4-7) 


(4-8) 


(4-9) 


(4-10) 


The  noise  vector,  w  (t),  is  given  by 


with  covariance  kernal  E{w  (t)w  (t  +t)}  *  Q  6(x),  where 


(4-12 


The  augmented  system  model  described  in  Equations  (4-5)  through 
(4-12)  is  used  to  design  either  the  continuous-time  Kalman  filter  in 
Equations  (2- 12a)  and  (2- 12b)  or  the  sampled-data  Kalman  filter  in 
Equations  (2-76)  through  (2-79).  However,  it  is  not  necessary  to  feed 
back  the  uncertainty  model  states  in  the  controller  algorithm;  they  are 
used  only  to  modify  che  filter  within  the  overall  controller.  Therefore 
the  original  system  model  is  used  to  design  the  LQ  regulator  of  Chapter 
II  or  the  PI  controller  of  Chapter  III.  However,  the  dimensions  of  the 
Kalman  filter  and  the  controller  are  now  incompatible.  This  is  solved 
by  augmenting  the  controller  gain  matrix  with  zeros 


l 

1 


(4-13 


Thus,  the  order  of  the  original  system  has  been  increased  to  reflect  the 
adding  of  uncertainty  model  states,  but  these  are  fed  back  through  the 
controller  with  zero  gains. 

At  this  point,  the  control  law  is  put  into  the  continuous-time 
generic  form  of  Equations  (2-25)  and  (2-26)  or  the  sampled-data  form  of 
Equations  (2-82)  and  (2-63).  then,  the  performance  of  the  robustified 
system  is  evaluated  using  the  performance  analysis  described  in  Chapter 


4.3  Shaping  Filter  Design 
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The  time-correlated  noise  processes  to  be  examined  in  this  thesis 
are  generated  by  inputting  white  noise  to  first-  or  second-order  shaping 
filters  as  described  in  Reference  23:180-186.  The  following  sections 
describe  the  form  of  the  shaping  filters. 

4.3.1  First-Order  Colored  Noise  Processes 

A  noise  process  which  has  low  intensity  at  low  frequencies  and  high 
intensity  at  high  frequencies  (or  high  intensity  at  low  frequencies  and 
low  intensity  at  high  frequencies)  can  be  generated  as  the  output  of  a 
system  with  a  transfer  function  of  the  form 


xu(s)  =  s  +  a 
w  (s)  s  +  b 


(4-14) 


In  Chapter  V,  it  is  shown  that  the  model  used  for  this  thesis  is  adequate 
for  low  frequencies  but  may  not  be  for  higher  frequencies.  Thus,  for  this 
case,  the  strength  of  the  noise  should  be  kept  low  at  low  frequencies  and 
then  increased  where  the  adequacy  of  the  model  is  in  doubt.  Figure  (4-1) 
shows  the  power  spectral  density  function  for  this  process. 

Using  the  standard  controllable  form  given  in  Reference  23:Ch  2,  the 


state-space  representation  for  Equation  (4-14)  is 


*u<c)  "  “b  xu(t)  +  wu(t) 


(4-15a) 


nu(t)  -  (a  -  b)  xu(t)  +  wu(t) 


(4—1 5b ) 


For  this  first-order  shaping  filter,  the  uncertainty  model  matrices 


are  thus  scalar  and  given  by 


w. 


Min 
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Figure  4-1:  Power  Spectral  Density  Function  for  a  First-Order  Shaping  Filter 


(4- 16a) 


B  -  1 


u 


(4- 16b) 


Hu  -  (a  -  b)  (4- 16c) 

Du  -  1  (4-16d) 


Note  Chat  a  noise  process  is  generated  for  each  control  applied  to 
the  system.  Thus,  the  dimension  of  the  augmented  system  is  that  of  the 
basic  system  plus  the  number  of  controls. 


4.3.2  Second-Order  Colored  Noise  Processes 

A  noise  process  which  has  high  intensity  over  only  a  limited 
frequency  range  can  be  generated  by  passing  white  noise  through  a  linear 
system  model  that  has  a  transfer  function  of  the  form 


xu(s)  ^  s  +  c 

tT^sT  (s  +  d)  (s  +  e) 


(4-17) 


If  it  is  the  case  where  the  adequacy  of  the  design  model  is  in  doubt  over 
a  limited  frequency  range,  then  a  second-order  shaping  filter  as  in 
Equation  (4-17)  would  be  appropriate.  The  power  spectral  density  function 
for  this  process  is  shown  in  Figure  (4-2). 

A  state-space  representation  for  this  process,  using  standard  control¬ 
lable  form  is  given  by 


*uj(t) 


X  (t) 
u2 


0  1 

xu,(t) 

+ 

0 

-de  -(d  e) 

X  (t) 

1 

L  u2 

(4-18a) 
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Figure  4-2:  Power  Spectral  Density  Function  for  a  Second-Order  Colored  Noise  Process 


(4- 18b) 
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For  this  second-order  shaping  filter,  the  uncertainty  model  matrices 
are  thus  given  by 


-de  -(d  +  e) 


(4-19a) 


(4- 19b) 
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[•  ■] 
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(4-19c) 


(4-19d) 


For  this  case,  the  dimensionality  of  the  original  system  is  increased 
by  two  times  the  number  of  controls  when  these  shaping  filter  states  are 
augmented  to  the  system  states. 

The  above  technique  for  robustifying  the  Kalman  filter  in  a  control 
system  is  incorporated  into  two  subroutines  added  to  the  LQG  regulator 
design  program  described  in  Reference  21.  Source  code  and  instructions 
for  running  the  program  with  the  additional  routines  are  listed  in 
Appendix  B. 
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Similarly,  for  PI  controllers,  the  user  must  input  the  original 
design  model,  before  augmenting  the  shaping  filter  states,  to  the  program 
described  in  Reference  13.  The  original  model  is  used  to  design  the  PI 
controller.  Then,  the  shaping  filter  states  are  augmented  with  the 
model  for  the  Kalman  filter  design.  Finally,  the  PI  controller  feedback 
gain  matrix  is  augmented  with  zeros  to  make  the  dimensions  of  the  two 
solutions  compatible.  Modifications  to  the  software  in  Reference  13  are 
listed  in  Appendix  C. 

4 .4  Summary 

This  chapter  has  presented  an  extension  to  the  Doyle  and  Stein 
robustness  method  of  injecting  white  input  noise  into  a  controlled  system 
during  the  process  of  tuning  the  Kalman  filter.  The  extension  allows 
time-correlated  noise  to  be  injected  into  the  system  model,  which  is 
accomplished  by  augmenting  shaping  filter  states  to  the  state  different¬ 
ial  equations  of  the  system  to  be  controlled.  Thus,  the  strength  of  the 
colored  noise  can  be  concentrated  at  frequencies  where  robust if icat ion 
is  desired  and  attenuated  elsewhere. 

Two  types  of  shaping  filters  to  generate  the  colored  noise  were 
examined.  The  first  concentrated  the  strength  of  the  noise  at  higher 
frequencies.  The  second  concentrated  the  strength  of  the  noise  over  a 
limited  frequency  range.  Then,  the  method  was  applied  to  the  types  of 
controllers  discussed  in  this  thesis. 

At  this  point,  the  types  of  controllers  which  are  designed  for 
this  thesis  have  been  discussed.  In  addition,  techniques  to  enhance  the 
robustness  characteristics  of  the  controllers  have  been  presented.  The 
following  chapter  presents  the  linear,  time- invariant  model  to  which  the 
above  mentioned  methods  are  applied  in  this  thesis. 
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5.1  Introduction 


This  chapter  presents  the  longitudinal  dynamic  equations  for  the 
Advanced  Fighter  Technology  Integration  aircraft,  an  F— 16  aircraft  (AFTI/ 
F-16)  modified  for  advanced  controls  research.  For  longitudinal  control, 
the  aircraft  is  equipped  with  a  decoupled  horizontal  tail  and  trailing 
edge  flap  which  make  it  possible  for  the  AFTI/F-16  to  perform  such 
maneuvers  as  pitch  pointing.  A  pitch-pointing  maneuver  allows  the  air¬ 
craft's  attitude  angle  to  be  changed  while  holding  the  flight  path  angle 
constant.  The  controllers  to  be  designed  lend  themselves  readily  to 
multiple-input  multiple-output  (MIMO)  system  methods  such  as  those 
described  in  this  thesis.  The  aircraft  equations  are  adequately  portrayed 
as  linear  and  time  invariant  by  linearization  about  specified  trim 
conditions  in  the  aircraft's  flight  envelope.  The  controllers  described 
in  earlier  chapters  will  be  designed  for  the  AFTI/F-16,  applying  the 
techniques  of  tuning  the  Kalman  filter  for  robustness  purposes  by  inject¬ 
ing  fictitious  white  or  time-correlated  noise  into  the  system  model  at 
the  point  of  entry  of  the  control  inputs. 

Data  used  to  form  the  AFTI/F-16  longitudinal  equations  was  taken 
from  References  11  and  12.  Reference  11  lists  dimensional  stability 
derivatives  in  a  body-axis  coordinate  system  for  the  aircraft,  but  does 
not  include  data  for  the  trailing-edge  flap.  This  information  is  given 
in  Reference  12  in  a  stability-axis  coordinate  system.  The  necessary 
transformations  were  performed  to  convert  all  values  to  the  body-axis 


frame. 


The  development  of  a  linear  perturbation  model  for  an  aircraft's 
longitudinal  dynamics  is  found  in  References  7;8;9;  10; 25 .  The  model  for 
clear  air  turbulence  is  developed  in  Reference  17  and  used  in  Reference 
12.  Both  these  models  are  incorporated  to  form  the  AFTI/F-16  equations 
described  later  in  this  chapter. 

The  first  section  of  this  chapter  describes  a  thirteen-state  linear 
perturbation  truth  model  for  the  AFTI/F-16.  This  thirteen-state  model 
is  unobservable  because  a  measurement  is  not  available  for  all  four  air¬ 
craft  states.  Therefore,  the  unobservable  state  is  deleted  from  the  full 
model  to  leave  a  twelve-state  truth  model.  This  model,  described  in  a 
second  section,  will  be  used  to  evaluate  the  performance  of  lower  order 
controller  models.  The  lower  order  (eight-state)  controller  model  is 
described  in  a  third  section.  The  final  section  gives  the  data  and 
longitudinal  equations  for  one  twelve-state  truth  model  at  an  off-design 
flight  condition.  This  will  be  used  to  evaluate  the  robustness  of  the 


controllers  designed. 

5.2  AFTI/F-16  Truth  Model 

The  longitudinal  aircraft  truth  model  consists  of  four  aircraft 
states,  three  turbulence  (gust)  states,  and  six  additional  states  to 
describe  the  third  order  dynamics  for  each  of  the  horizontal  tail  and 
trailing-edge-flap  actuators.  The  aircraft  states  are:  0,  attitude 
angle;  a,  angle  of  attack,  q,  pitch  rate,  and;  u,  forward  perturbation 
velocity.  There  are  two  angle  of  attack  gust  states  and  one  pitch-rate 
gust  state.  Noise-corrupted  measurements  are  available  for  G,  a,  and 
q,  and  the  measurement  for  a  includes  an  angle-of-attack  gust  state. 

The  actuator  and  gust  models  will  be  described  first. 


5.2.1  Actuator  Dynamics 

The  actuators  for  the  horizontal  tail  and  trailing-edge-flap  are 

modeled  as  third-order  systems,  yielding  delivered  angle  6  in  response  to 

commanded  angle  £  ,  of  the  form 

com 

6<s)  (  1/T  )  (cjJ  2) 

_  _  8  n 

(s)  (s  +  1/T  )  (s2  2£  to  s  +  w  2) 

com  s  n  n 

Multiplying  the  numerator  and  denominator  terms  yields 

6(s)  a 

*  o 

3  2 

(s)  s  +  a0s  +  a.s  +  a 
com  2  1  o 


(5-1) 


(5-2) 


Using  the  standard  observable  state  space  representation  given  in 
Reference  23:Ch  2,  the  corresponding  model  is 
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(5-3b) 


where  the  b^’s  arise  when  taking  the  Laurent  series  for  G(s).  Notice 

that  is  the  command  surface  deflection  and  6  is  the  surface  deflec- 

com 

tion  output  from  the  actuators.  Two  intermediate  states,  <Sj  and  62,  are 
needed  to  describe  fully  the  actuator  dynamics. 
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The  values  chosen  for  Che  parameters  in  GquaCion  (5-1)  are  specified 


in  Reference  27  as 


°''3)  _  _  (20.2)  (71.4)  _ 

6  (s)  (s  +  20.2)  (s2+  2(  .736)  (71.4)+  71. 42) 


(5-4) 


The  same  actuator  equations  are  used  for  both  the  horizontal  tail  and 
trailing-edge-flap.  Expanding  Equation  (5-4)  yields 


6(s)  102980 

5  (s)  (s3  +  125.3a2  +  7221s  +  102980) 

com 


(5-5) 


Thus  the  resulting  state  equation  is 
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5.2.2  Turbalence  State  Equations 

The  model  used  for  clear  air  turbulence  is  found  in  References  12 
and  17.  The  state  equations  for  the  three  gust  states  are  given  by 


a  ■  a  a  +  n 
8  g,  8  a 


(5-7a) 


ct  **  a  a  +  ®ot  -  an 
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(5-7b) 
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The  noise  source,  n^,  is  modeled  as  a  white  Gaussian  noise  with  statistics 


E{na(t)}  -  0 


(5-8a) 


E{n^(t)  n^  (t  +  t)}  -<SCt) 


(5-8b) 


The  coefficients  in  Equations  (5-7)  are  computed  using  the  following 
equations 


'  -v 
a  -  t 

S1  L 

w 


(5“9a) 
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Vt  is  aircraft  velocity  and  b  is  the  wing  span.  The  quantities  crw  and 
L  are  given  in  Reference  3  as  functions  of  altitude,  where  a  is  the 

W  W 

root  mean  square  intensity  of  the  clear  air  turbulence  in  feet  per 


second  and  L  is  a  reference  scale  length  in  feet, 
w 

5.2.3  System  Equations 

The  thirteen  states  for  the  unobservable  truth  model  are  listed  in 

Equation  (5-10)  on  the  following  page. 

As  demonstrated  in  Reference  12 ,  it  is  convenient  to  define  the 

truth  model  equations  in  two  stages.  First,  define  the  ssytem  matrix, 

« 

of  Equation  (2-25),  neglecting  all  a  stability  derivative  terms  and  also 

the  ot  term  in  Equation  (5-7c).  Then  modify  the  matrix  to  incorporate  the 
© 

neglected  terms.  This  is  done  for  mathematical  convenience  as  the  a  terms 
are  neglected  in  a  later  truth  model.  Defining  the  system  matrix  in  two 
stages  does  not  change  the  definition  of  the  states;  the  second  stage  is 
merely  a  more  adequate  model.  The  initial  matrix  is  given  in  Equation 
(5-11)  on  the  following  page. 

To  incorporate  the  neglected  terms,  rows  2,3,4  and  13  are  modified 
with  the  following  equations  (using  standard  double-index  array  notation 
Ft(I,J)  for  the  I-th  row  and  J-th  column  of  Ft). 

Ft(2,J)  -  F^(2,J)  /(l.  -  Z^)  (5- 12a) 

F  (3,J)  -  FJ(3,J)  +  M.  x  F  (2,J)  (5-12b) 

t  t  a  c 

Ft(4,J)  -  FJ(4,J)  +  X.  x  Ft(2,J)  (5-12c) 

F  ( 13, J)  -  F’(  13, J)  +  aw  x  F'(12,J)  (5-12d) 

t  t  gj  t 


The  column  index  J  ranges  from  1  to  13 


In  Equations  (5-11)  and  (5-12),  the  dimensional  stability  deriva¬ 
tives  "X",  "Z",  and  "M"  refer  to  body  forces  acting  along  the  X-  and  Z- 
axes  (forward  and  down  axes)  and  the  pitching  moment  about  the  Y-axis, 

(axis  emanating  from  aircraft  center  of  mass  toward  the  right  wing) 
respectively.  The  subscript  identifies  the  state  with  respect  to  which 
the  derivative  is  taken.  The  term  "g"  is  the  acceleration  due  to  gravity. 
The  subscripts  HT  and  TEF  refer  to  deflections  of  the  horizontal  tail  and 
trailing-edge-flap,  respectively.  The  terms  aQ,  uQ  and  wq  refer  to  trim 
values  of  angle  of  attack,  and  velocity  components  along  the  X-  and  Z- 
axes,  respectively.  A  trim  condition  is  a  steady-state  level  flight  condi¬ 
tion  about  which  the  longitudinal  dynamic  equations  are  linearized.  For 
this  case,  the  trim  condition  is  chosen  to  be  steady  level  flight  at  a 
Mach  number  of  0.6  and  an  altitude  of  10,000  feet. 

Table  (5-1)  gives  the  values  needed  to  define  the  thirteen-state 
truth  model.  Note  that  the  value  of  dw  given  in  the  gust  model  coefficients 
is  for  "Level  1"  or  light  to  moderate  air  turbulence.  This  level  of  air 
turbulence  has  a  high  probability  of  being  encountered  in  flight. 

From  Chapter  II,  the  truth  model  is  of  the  form 

2^(0  -  Ft  x^t)  +  Bt  u(t)  +  Gt  Wj-Ct)  (5-13) 

The  control  vector,  u^,  is  given  by 

u  ■ 
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(5-14) 
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AFTI/F-16  Data  for  M  -  0.6,  H  **  10,000  Feet 
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The  Bt  and  matrices  are  given  by  Equations  (5-15)  and  (5-16)  on  the 
following  page.  The  last  element  of  the  Gfc  matrix  is  defined  to  be 


"n  *  %  *  *n  (5-17) 

where  a  and  a  were  defined  previously  in  Equations  (5-9d)  and  (5-9e). 
n  8d 

Employing  the  data  of  Table  (5-1)  and  Equations  (5-11)  and  (5-12), 
the  F£  matrix  is  given  by  Equation  (5-18).  Equations  (5-19)  through  (5-22) 
give  the  other  system  matrices  with  their  numerical  values  inserted. 

Recall  the  continuous-time  measurement  equation  is  of  the  form 


z^t)  -  Ht  ^  ♦  v^t) 


(5-23) 


The  covariance  kernel  description,  R..,  for  the  measurement  noise,  v  (t), 

c  — t 

(Equation  (2-28))  was  established  using  the  values  given  in  Reference  12. 
The  results  are  listed  in  Equation  (5-24). 
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(5-24) 


Recall  from  Equation  (2-120)  that  a  first  order  approximation  for  a 
discrete-time  Rdt’  to  be  used  to  design  a  sampled-data  controller  is  given 
by 


*dt  ' 


(5-25) 


The  truth  model  described  above  will  hereafter  be  referred  to  as 
(TI3, 10,0.6) .  "T"  indicates  truth  model,  13  refers  to  the  number  of 


The  truth  model  of  the  previous  section  represents  an  unobservable 
system  because  a  measurement  of  the  fourth  state,  u,  is  unavailable.  In 


practice,  it  is  rarely  desirable  to  feed  back  this  state  through  a  control¬ 
ler.  Therefore,  the  fourth  state  is  deleted  from  the  truth  model  before 
any  further  simplification  to  yield  models  upon  which  to  base  a  controller/ 
estimator  design.  In  addition,  all  terms  involving  &  stability  deriva¬ 
tions  are  ignored  because  their  effects  on  the  terms  of  Equation  (5-19) 
are  negligible.  Incorporating  these  derivatives  causes  the  values  for  the 
Ft  matrix  to  change  only  slightly,  except  for  the  terms  involving,  u,  which 
were  deleted.  Thus,  the  modifications  listed  in  Equations  (5-12a),  (5-12b) 
and  (5- 12c)  are  not  necessary.  Equation  (5- I 2d)  now  becomes 


Ft(12,J) 


F' (  12, J)  +  a  x  F'(11,J) 
C  ®d  t 


(5-26) 


The  matrices  needed  to  define  the  twelve-state  truth  model  are  given 
in  Equations  (5-27)  through  (5-33).  Note  that  Rt  was  defined  previously 
in  Equation  (5-24). 

The  twelve-state  truth  model  based  on  linearization  about  a  trim 
condition  at  10000  feet  and  Mach  0.6  will  be  referred  to  as  (T12, 10,0.6) . 

5.4  Controller  Design  Model 

The  reduced  order  controller  is  formed  by  modelling  the  AFTI/F-16 
actuator  dynamics  as  first-order  lags  instead  of  third-order  systems  as 


-2.151X10  -6.25 


given  in  Equation  (5-1).  The  transfer  function  for  a  first-order  lag 

with  a  coefficient  of  1/T  ,  i.e.,  a  lag  time  of  T  ,  is  given  fay 

s  s 

6(a)  1/Tg 

'  TTT7fl  <5‘ 

In  state  space  representation ,  the  above  equation  becomes 


<S(t)  -  (“1/T  )  6(t)  +  (1/T  )  «  (t)  (5-35) 

s  s  com 

where  T  is  the  time  constant  for  the  actuator.  Again*  6  is  the  com- 
s  com 

mand  surface  deflection  and  6  is  the  surface  deflection  output  from  the 

actuator.  A  good  fit  to  the  frequency  response  of  the  actuators  yields 

1/T  •  20.2  (Ref  27).  Equation  (5-35)  then  becomes 

s 

• 

5(t)  -  “20.2  $(t)  +  20.2  <$  (t)  (5-36) 

com 

Making  this  modification  to  the  twelve-state  truth  model  of  Section 
5.3  yields  an  eight-state  controller  design  model.  The  matrices  needed 
to  define  the  controller  model  are  given  in  Equations  (5-37)  through  (5-43) . 
This  eight-state  controller  model  will  be  referred  to  as  (C8,10*0.6). 

5.5  Truth  Models  at  Off-Design  Conditions 

To  evaluate  the  effectiveness  of  the  techniques  previous  described  for 
robustifylng  the  Kalman  filter *  the  performance  of  the  controllers  are  to 
be  evaluated  at  flight  conditions  other  than  that  for  which  the  controllers 
were  designed*  as  well  as  by  using  truth  models  of  higher  order  than  the 
design  model.  This  is  accomplished  by  using  a  truth  model  defined  at  an 
off-design  condition  in  the  performance  analysis  described  in  Chapter  III. 
The  following  sections  contain  one  such  truth  model. 


This  truth  model  is  defined  for  an  altitude  of  20,000  feet  and  a 


5.5.  I 


Mach  number  of  0.6.  The  values  of  parameters  and  stability  derivatives 
needed  to  form  the  system  matrices  are  given  in  Table  (5-2).  The  truth 
model  Gt  and  Ffc  matrices  are  given  in  Equation  (5-44)  and  (5-45). 


(5-44) 


5.6  Summai 


7.052X10 


.1591 


This  chapter  has  presented  the  model  which  will  be  used  to  design  LQG 
regulators  as  in  Chapter  II  and  FI  controllers  as  in  Chapter  III  for  the 
AFTI/F-16.  The  robustification  methods  detailed  in  Chapters  II  and  IV  will 
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be  applied  to  the  model,  and  the  effect  of  this  will  be  examined  by 
performing  covariance  analysis  as  described  in  Chapter  II.  The  results 


of  this  study  are  presented  in  the  following  chapter. 
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VI.  Results 


6.1  Introduction 

The  results  of  the  study  of  methods  to  Improve  the  robustness 
properties  of  controlled  systems  are  presented  in  this  chapter.  The  two 
methods  examined  are  the  techniques  of  tuning  the  Kalman  filter  by  Input¬ 
ting  both  stationary  white  and  time-correlated  Gaussian  noise  Into  the 
system  model  at  the  control  entry  points. 

The  results  of  applying  these  techniques  are  presented  first  for  LQG 
regulators.  In  the  first  sections,  results  are  given  for  a  continuous¬ 
time  system.  Then,  two  approaches  for  a  discrete-time  system  are  examined 
discretizing  the  continuous- time  controller  using  first-order  approxima¬ 
tions,  and  designing  a  sampled-data  controller. 

Finally,  In  the  last  sections,  the  robustlfication  techniques  are 
applied  to  a  sampled-data  PI  controller. 

6.2  Robust  LQG  Regulators 

Two  separate  issues  of  robustness  are  addressed  in  the  following 
sections.  The  first  is  the  idea  of  robustifying  a  system  against  dif¬ 
ferences  between  the  real  world  and  the  finite-dimension,  low-order  model 
that  is  chosen  for  controller  and  Kalman  filter  design.  As  discussed  in 
Chapter  V,  the  model  to  represent  the  real  world  (the  truth  model)  and 
the  lower-order  controller  model  were  purposefully  established  so  that  the 
differences  between  them  occur  in  a  specific  high  frequency  range.  As  pro¬ 
posed  by  Doyle  and  Stein  (Ref  6) ,  the  stability  characteristics  of  a  full- 
state  feedback  system  can  be  recovered  by  adding  white  noise  at  the 
control  entry  points  during  the  process  of  filter  tuning.  The  validity 


of  this  claim  is  examined  by  looking  first  at  a  purposefully  reduced-order 
controller  evaluated  against  a  truth  model  of  the  same  dimension  with 
first-order  actuator  dynamics.  That  is,  the  low-order  controller  model 
is  evaluated  as  if  it  were  a  perfect  representation  of  the  real-world 
system.  The  performance  of  this  controller  is  the  best  that  can  be  expected 
with  a  Kalman  filter  to  estimate  the  states.  Then,  the  higher-order 
actuator  dynamics  are  introduced  into  the  truth  model  to  demonstrate  the 
effects  of  ignored  states  on  the  performance  of  the  system.  Next,  the 
robustification  techniques  are  introduced  to  attempt  to  recover  the 
stability  characteristics  of  a  reduced  order  but  full-state  feedback  system. 

It  would  be  desirable  also  to  examine  the  performance  of  a  full-state 
feedback  system  to  evaluate  the  claim  that  the  stability  robustness 
properties  of  the  filter-based  controller  will  asymptotically  approach 
those  of  the  full-state  feedback  controller  using  the  Doyle  and  Stein 
technique.  Unfortunately,  the  software  used  to  design  and  evalute  LQG 
regulators  does  not  include  the  option  of  designing  an  LQ  full-state 
controller.  An  attempt  was  made  to  approximate  full-state  feedback  by 
setting  the  measurement  noise  intensities  to  small  values  and  assuming  a 
measurement  was  available  for  each  state,  but  the  results  were  inconclusive. 
Therefore,  performance  comparisons  are  only  presented  between  designs 
using  the  robustified  or  unmodified  Kalman  filter. 

As  discussed  in  Chapter  V,  the  difference  between  the  controller 
design  model  and  the  truth  model  against  which  the  performance  is 
evaluated  lies  in  the  dynamics  model  for  the  actuators.  Open  loop 
frequency  responses  for  the  third-order  model  and  the  first-order  model 
are  shown  in  Figure  (6-1) .  It  is  seen  that  the  frequency  responses  differ 


in  the  region  around  70  rad/sec  and  beyond,  where  the  complex  poles  are 
located  in  the  third-order  model.  Robust if icat ion  of  the  LQG  controller 
based  on  the  reduced-order  model  can  be  accomplished  by  adding  white  noise 
to  the  filter's  system  model  at  the  point  of  entry  of  _u,  or,  by  adding 
time-correlated  noise  with  the  primary  power  concentrated  around  the 
region  of  the  model  inadequacy,  i.e.,  around  70  rad /sec  and  higher. 

One  first-order  and  one  second-order  shaping  filter  transfer  function 
are  considered,  each  of  which  concentrates  the  highest  strength  of  the 
time-correlated  noise  in  the  region  where  the  design  model  and  truth-model 
actuator  dynamics  differ.  The  first-order  shaping  filter  is  described 


by  the  transfer  function 
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s  +  0.5 


w  s  +  50 
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(6-1) 


A  power  spectral  density  plot  of  the  time-correlated  noise  generated  by 
this  shaping  filter  is  shown  in  Figure  (6-2a) . 

The  second-order  shaping  filter  is  described  by  the  transfer  function 
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(s  +  50)  (s  +  400) 


(6-2) 


Figure  (6-2b)  shows  the  power  spectral  density  function  for  the  time- 
correlated  noise  generated  by  the  above  shaping  filter.  The  values  in 
Equations  (6-1)  and  (6-2)  were  chosen  by  examining  power  spectral  density 
plots  of  the  time-correlated  noise  with  the  poles  and  zeroes  of  the 
shaping  filters  in  different  locations.  The  chosen  values  generate  the 
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Figure  6-2a:  First-Order  Colored  Noise  Process 
Power  Spectral  Density 
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Figure  6-2b:  Second-Order  Colored  Noise  Process 
Power  Spectral  Density 
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desired  noise,  the  strength  of  which  is  highest  in  the  frequencies  where 
the  truth  and  design  model  frequency  responses  differ. 

The  second  robustness  issue  is  concerned  with  operation  of  the  con¬ 
trolled  system  at  flight  conditions  other  than  the  design  condition.  The 
differences  between  the  real  world  and  the  reduced-order  design  model 
now  occur  in  other  frequency  ranges  besides  those  given  by  the  actuator 
dynamics  models.  Since  these  frequency  ranges  are  now  unknown,  the  use  of 
white  input  noise  would  be  motivated  since  it  injects  equal  uncertainty 
into  the  system  model  over  the  entire  frequency  spectrum.  The  additional 
performance  degradation  or  instabilities  that  arise  in  going  from  the 
design  condition  to  an  off-design  condition  with  a  Kalman  filter  in  the 
loop  are  examined  to  determine  the  success  of  the  Kalman  filter  robust- 
ification  techniques.  That  is,  if  the  full-state  feedback  system  (based 
on  a  reduced-order  design  model)  is  stable,  then  the  LQG  system  (which 
may  well  yield  an  unstable  closed-loop  system  with  the  unrobustlfied 
filter  in  the  loop)  can  be  stabilized  with  the  addition  of  white  input 
noise  (as  claimed  by  Ref  6)  and  possibly  by  colored  noise  if  the  robust- 
iflcatlon  is  applied  over  the  appropriate  frequency  ranges. 

The  cost-weighting  matrices  used  in  Equation  (2-3)  are  the  same  for 
the  continuous- time,  discretized,  and  sampled-data  regulators  (discretiz¬ 
ing  (2-3)  to  yield  (2-69)  is  accomplished  as  in  Ref  24) .  The  values  used 
are  based  on  those  given  in  References  12  and  22,  with  some  iteration  on 
the  control  weightings  to  achieve  designs  with  commanded  control  surface 
deflections  that  do  not  exceed  physical  limits  of  the  horizontal  tail  and 
tailing-edge  flap.  The  state,  control  and  cross-weighting  matrices  are 
given  by 
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It  is  desired  to  make  a  direct  comparison  between  the  performance 
of  the  controlled  system  with  white  and  time-correlated  input  noise  added 
to  the  model  upon  which  the  Kalman  filter  is  based,  where  the  maximum 
intensity  of  the  time-correlated  noise  is  equal  to  the  intensity  of  the 
white  noise.  By  equating  the  maximum  magnitudes  of  the  white  and  time- 
correlated  noise,  it  can  be  determined  if  there  are  performance  benefits 
in  choosing  one  type  of  noise  over  another  by  comparing  the  degree  of 
robustificatlon  achieved  by  each.  This  is  accomplished  using  the  fre¬ 
quency  domain  shaping  filter  design  techniques  in  Reference  23,  which 
state  that 
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where  PSD^  and  PSDq  are  the  power  spectral  densities  of  the  input  and 
output  of  a  shaping  filter,  respectively.  G(s)  is  the  transfer  function 
of  the  shaping  filter.  It  is  desired  to  have  the  maximum  magnitude  of 
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the  right-hand  side  of  Equation  (6-6)  be  equal  the  magnitude  of  the 

2 

white  input  noise,  (the  scalar  white  noise  parameter,  q  of  Equation 

2 

(2-64)).  Thus,  by  setting  PSDq  equal  to  q  and  solving  for  the  value  of 

PSD^  which  makes  this  true,  the  value  of  in  Equation  (4-12)  can  be 

found  for  the  time-correlated  noise.  Thus,  it  is  the  Intensity,  Q^, 

of  the  white  driving  noise,  w^(t)  to  the  shaping  filter  which  will 

2 

generate  a  time-correlated  noise  with  a  maximum  intensity  of  q  .  Table 
(6-1)  lists  the  values  of  which  make  the  maximum  intensity  of  the 


Table  6-1 


Strength  of  Dynamic  Driving  Noise  to  Shaping  Filters 


time-correlated  noise  equal  to  that  of  the  white  noise.  The  values  were 
arrived  at  using  the  software  described  in  Reference  20. 


6,2.1  Continuous-Time  LQG  Regulators  at  Design  Condition 


Figure  (6-3)  shows  time  histories  of  the  mean  and  standard  deviation 
of  the  aircraft  state,  6,  for  an  eight-state  controller  evaluated  against 
a  truth  model  of  the  same  dimension  (the  truth  model  and  controller 
model  are  identical  as  given  in  Section  5.4).  A  perfectly  known  initial 
condition  of  one  degree  (or  0.0175  radians)  was  placed  on  0,  and  the 
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plot  shows  the  response  of  @  to  the  initial  perturbation  and  to  the  dynamic 
driving  noise  built  into  the  model.  The  trends  are  similar  for  all  three 
aircraft  states,  therefore  only  one  will  be  examined  in  detail  in  this 
chapter . 

The  time  response  is  stable,  although  slow.  The  slow  response  is 
typical  of  systems  with  a  Kalman  filter  to  estimate  states.  The  added 
dynamics  of  the  filter  tend  to  slow  down  the  response.  However,  the 
controller  does  respond  to  the  perturbation  and  regulate  the  state  back 
to  zero.  Figure  (6-4)  shows  the  response  of  the  same  controller  when 
specific  ignored  states  are  now  accounted  for  in  the  truth  model.  This 
figure  is  the  result  of  a  performance  analysis  when  third-order  actuator 
dynamics  are  included  in  the  twelve-state  truth  model,  while  only  first- 
order  dynamics  are  used  in  the  eight-state  design  model.  As  can  be  seen, 
the  system  is  still  stable,  bu  the  mean  of  G  response  has  degraded 
substantially,  especially  in  steady-state. 

Figures  (6-5a)  and  (6-5b)  show  the  response  of  the  same  state  with 
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a  white  Gaussian  noise  of  strength  q  •  1  x  10  injected  into  the  system 
model.  The  transient  time,  the  overshoot,  and  the  error  in  the  final 
mean  value  of  G  have  all  been  substantially  improved  with  the  noise  addi¬ 
tion.  The  standard  deviation  of  G  has  not  changed  noticeably  from  the 

2 

previous  case.  The  trend  for  lower  and  higher  **  values  is  shown  in 
Figures  (6-5c»e,d,f ) .  It  is  seen  that  noise  of  a  very  small  intensity 
(lx  10 ”  )  enhances  the  robustness  properties  dramatically,  and  Increasing 
the  intensity  of  the  noise  only  serves  to  change  the  transient  characteris¬ 
tics  of  the  mean  time  response  and  the  magnitude  of  the  standard  deviation. 
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Then,  as  shown  in  Figure  (6-6),  time-correlated  noise  generated  by  a 

first-order  shaping  filter  is  injected  into  the  system  model.  The  maximum 
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power  spectral  density  of  the  noise  is  1  x  10  .  The  figure  demonstrates 

that  the  improvement  in  the  transient  time,  overshoot,  and  final  value  of 
0  is  as  dramatic  as  for  the  white  noise  case.  Again,  the  standard 
deviation  has  not  changed  enough  to  be  discernible  in  the  figure. 

Finally,  time-correlated  noise  generated  by  a  second-order  shaping 
filter  is  injected  into  the  design  model.  As  can  be  seen  in  Figure  (6-7), 
the  transient  time  is  approximately  the  same  as  for  the  original  system, 
but  much  slower  than  the  cases  above.  However,  the  state  is  converging 
to  zero,  and  the  overshoot  has  been  reduced  to  about  half  of  the  original 
value.  Any  change  in  the  steady-state  value  of  the  standard  deviation  is 
not  noticeable  in  the  figure. 

Thus,  Figures  (6-3)  through  (6-7)  demonstrate  that  the  robustif ication 
techniques  can  recover  the  stability  robustness  characteristics  that 
would  be  expected  from  a  full-state  feedback  system.  The  methods  of 
injecting  white  and  first-order  colored  noise  produce  very  similar 
improvements,  while  the  second-order  colored  noise  produced  less  but 
still  noticeable  benefits  in  the  time  response. 

However,  it  was  stated  in  previous  chapters  that  the  addition  of 
noise  into  the  design  model  will  degrade  the  performance  (as  measured  by 
the  standard  deviation  of  the  states  or  how  well  known  the  states  are)  of 
the  system  at  the  design  conditions.  Additionally,  it  was  claimed  that 
the  performance  degradation  will  be  less  for  colored  noise  than  for  white 
noise.  To  evaluate  this  claim.  Table  (6-2)  lists  the  steady-state  values 
of  the  standard  deviations  of  all  three  aircraft  states  with  no  input 
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Figure  6-7a:  Mean  of  9  With  Second-Order  Colored  Noise  Addition 
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Figure  6— 7b :  Standard  Deviation  of  9  With  Second-Order 
Colored  Noise  Addition 


noise,  white  noise,  and  first-order  and  second-order  time-correlated  noise 


for  one  value  of  noise  intensity.  The  values  listed  are  the  results  of  a 
performance  evaluation  where  the  unmodified  controller  design  model  and 
truth  model  are  identical  (both  are  of  dimension  eight  at  the  design 
condition) .  The  results  shown  in  the  table  only  partially  substantiate 
the  claim  that  time-correlated  noise  can  minimize  the  performance  degrada¬ 
tion.  The  addition  of  white  noise  to  the  system  model  Increased  the  stand¬ 
ard  deviation  of  all  three  aircraft  states  as  expected. 

It  was  expected  that  the  addition  of  first-order  colored  noise  would 
reduce  the  standard  deviation  of  the  aircraft  states  to  values  less  than 
those  for  white  noise,  but  still  larger  than  the  case  with  no  noise  addi¬ 
tion.  Table  (6-2)  shows  that  this  is  not  the  case.  Rather,  the  standard 
deviations  have  increased,  if  only  slightly  for  0  and  a.  Only  the  pitch 
rate,  q,  has  decreased  as  expected.  Recall  from  Figures  (6-5a)  and  (6-6a) 
that  white  and  first-order  colored  noise  produce  similar  mean  of  theta 
responses.  That  is,  the  robustness  enhancement  is  very  similar  for  the 
two  cases.  However,  even  though  the  added  uncertainty  is  applied  over  a 

Table  6-2 

Comparison  of  Steady-State  Deviations  of  Aircraft 
States  at  the  Design  Condition  for  a  Continuous 
Time  System 
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No  noise 
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8.705xl0"4 

5.035xl0’3 

1.200xl0“3 

White  Noise 

lxlO-4 
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9.590xl0“4 
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1 ,978xl0-3 
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Shaping  Filter 
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1.006xl0"3 

5.823xl0"3 
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Shaping  Filter 
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8.704xl0“4 

5.039xi(f3 

1.201xl0“3 

more  limited  frequency  range  when  first-order  colored  noise  is  injected 
into  the  model,  the  standard  deviations  have  increased  slightly.  This  is 
not  well  understood,  except  to  say  that  time-correlated  noise  actually 
changes  the  structure  of  the  Kalman  filter  design  model.  The  added 
complexity  of  the  design  model  may  overcome  any  benefits  that  are 
realized  because  the  noise  was  not  applied  over  all  frequencies  as  in  the 
white  noise  case. 

As  expected,  the  performance  at  design  conditions  is  degraded  less 
by  using  a  second-order  filter  as  opposed  to  a  first-order  filter  or  white 
noise.  However,  the  greater  complexity  of  the  Kalman  filter  design  model 
(four  additional  states  in  this  case)  is  not  justified  by  the  performance 
benefits  seen  in  Table  (6-2).  In  this  instance,  white  noise  injected  into 
the  system  design  model  provides  the  desired  robustificatlon  while  not 
degrading  the  performance  at  the  design  condition  substantially. 

Table  (6-3)  presents  similar  steady-state  standard  deviation  informa¬ 
tion  about  the  three  aircraft  states  as  shown  in  Table  (6-2).  However, 
the  values  listed  here  are  the  results  of  a  performance  evaluation  of  the 
eight-state  controller  evaluated  against  the  twelve-state  truth  model, 
accounting  for  higher-order  actuator  dynamics.  An  Important  difference 
between  Tables  (6-2)  and  (6-3)  is  the  effect  of  adding  white  input  noise 
on  the  standard  derivation  of  G.  At  the  design  condition,  adding  white 
noise  detunes  the  filter  and  results  in  a  performance  degradation.  How¬ 
ever,  when  third-order  actuator  dynamics  are  included  in  the  truth  model, 
adding  white  noise  Improves  the  tuning  for  the  G  channel,  and  the 
standard  deviation  decreases  for  this  state.  Thus,  when  the  performance 


of  the  system  is  evaluated  in  an  environment  different  from  the  design 
condition,  the  noise  addition  can  result  in  a  performance  enhancement. 

It  is  seen  that  for  this  case,  second-order  time  correlated  noise  again 
accomplishes  improved  filter  tuning  over  first-order  and  white  noise. 

The  improvement,  though,  is  still  not  substantial  enough  to  justify  the 
added  complexity  of  the  Kalman  filter  design  model.  White  input  noise, 
as  stated  above,  accomplishes  the  desired  robustness  enhancement  without 
adding  states  to  the  design  model. 


Table  6-3 

Comparison  of  Steady-State  Standard  Deviations 
of  Aircraft  States  with  Higher-Order  Actuator 
Dynamics  for  a  Continuous-Time  System. 


6.2.2  Continuous-Time  LQG  Regulators  at  Off-Design  Condition 

Figure  (6-8)  shows  the  results  of  a  performance  analysis  for  the 
unrobustified  system  with  a  Kalman  filter  at  an  off-design  flight  condi¬ 
tion  (712,20(0.6)  for  the  eight-state  controller  design  model.  As  shown 
in  the  figure,  the  system  is  unstable.  The  mean  of  0  is  diverging,  and 
the  standard  deviation  is  growing  with  time.  In  addition,  the  inputs 
generated  by  the  controller  are  growing  with  time  beyond  the  actual  limits 
of  the  control  surfaces  (fc23  degrees  for  the  horizontal  tail  and  ±20 
degrees  for  the  trailing-edge  flap:  Ref  27).  This  is  demonstrated  in  the 
mean  plots  of  Figure  (6-9) . 

Figures  (6-10a)  and  (6-10b)  show  the  system  responses  at  the  same  off- 
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design  flight  condition,  except  now  white  noise  of  strength  q  ■  1x10 
has  been  injected  into  the  filter's  sytem  model  at  the  control  entry 
points.  The  addition  of  this  noise  is  sufficient  to  stabilize  the  system, 
driving  the  aircraft  state  towards  zero  and  the  standard  deviation  of  the 
state  to  a  finite  value.  Figures  (6-10c,d,e,f )  demonstrate  the  trend  for 
a  lower  and  higher  value  of  ^  As  noted  before,  stability  is  recovered  with 
a  very  low  noise  strength.  Higher  values  change  only  transient  character¬ 
istics  and  the  magnitude  of  the  standard  deviation.  Figure  (6-11) 
demonstrates  that  the  mean  of  the  commanded  controls  are  no  longer  exceed¬ 
ing  the  physical  limits  of  the  control  surfaces.  However,  the  large 
initial  changes  in  the  command  inputs  do  exceed  the  actuator  rate  limits 
of  the  control  surfaces  because  there  is  no  weighting  on  input  rates  in 
the  cost  function  for  an  LQG  regulator. 

For  a  time-correlated  noise  generated  by  a  first-order  shaping  filter 
with  a  maximum  intensity  of  1x10  \  the  results  are  similar  to  those  of 
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Figure  6-10c:  Mean  of  0  With  White  Noise  Addition  with  an  Off-Design 
Flight  Condition 


Figure  6-10d:  Standard  Deviation  of  0  With  Whise  Noise  Addition  at 
An  Off-Design  Flight  Condition 
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Figure  6-10e:  Mean  of  6  With  White  Noise  Addition  at 
Off-Design  Flight  Condition 
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Figure  6-iOf:  Standard  Deviation  of  0  With  White  Noise 
Addition  at  Off-Design  Flight  Condition 
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Figure  6-1  la:  Mean  Horizontal  Tail  Commanded  Deflection 
With  White  Noise  Addition 


the  white  noise.  This  is  shown  in  Figure  (6-12).  At  the  off-design 
flight  condition  which  was  initially  unstable  with  no  noise  addition,  the 


response  is  stable  with  the  mean  of  9  approaching  zero,  and  the  standard 
deviation  approaching  a  finite  value. 

As  shown  in  Figure  (6-13),  the  addition  of  colored  noise  generated 

-4 

by  a  second-order  shaping  filter  with  a  maximum  intensity  of  1x10  is 

not  sufficient  to  stabilize  the  system.  The  standard  deviation  of  6  is 

growing  with  time,  although  the  mean  is  approaching  zero.  However,  increas 
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ing  the  intensity  to  1x10  ,  the  standard  deviation  does  approach  a  finite 

value  as  shown  in  Figure  (6-14) . 

Thus,  Figures  (6-10)  through  (6-14)  demonstrate  that  the  stability 
robustness  of  the  controlled  system  is  enhanced  by  the  addition  of  all 
three  types  of  input  noise,  such  that  the  response  of  the  system  is  stable 
even  in  the  face  of  parameter  changes  in  the  real  world.  White  and  first- 
order  colored  noise  of  the  same  maximum  intensity  produce  very  similar 
results.  Robustness  can  also  be  improved  using  second-order  colored 
noise,  but  a  greater  maximum  noise  intensity  is  necessary  to  achieve  a 
comparable  response  to  the  previous  two  cases.  Figure  (6-15)  shows  a 
power  spectral  density  plot  of  the  second-order  time-correlated  noise 
for  the  case  of  Qu  -  2100.  The  magnitude  of  the  time-correlated  noise  at 
low  frequencies  (at  0.1  Hz  and  below)  was  found  to  be  1.3x10  **,  after 
converting  from  decibels  to  a  linear  magnitude  scale.  Inputting  a  white 
noise  of  this  approximate  intensity  is  sufficient  to  recover  the  stability 
of  the  system  as  is  demonstrated  in  Figure  (6-16) .  This  implies  that  the 
robustness  improvement  is  not  primarily  due  to  the  time-correlated  noise 
concentrated  around  70  rad/sec;  rather  the  magnitude  of  the  noise 
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Figure  6- 12a:  Mean  of  9  With  First-Order  Colored  Noise 
Addition  at  Off-Design  Flight  Condition 


Figure  6—1 2b :  Standard  Deviation  of  9  With  First-Order  Colored 
Noise  Addition  at  Off-Design  Flight  Condition 


S 


.‘a*  •  .*  *.■  ‘-***»_* 


•sew 


124 


Qu  -  21 

(T12,20,0.6) 


2. 00  3. 00  4.00  5. 00  6. 00 

TIME.  T.  SECONDS 


Figure  6- 13b:  Standard  Deviation  of  S  With  Second-Order  Colored 
Noise  Addition  at  Off-Design  Flight  Condition 
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Figure  6- 14a:  Mean  of  0  With  Second-Order  Colored  Noise 
Addition  at  Off-Design  Flight  Condition 


Figure  6- 14b:  Standard  Deviation  of  G  With  Second-Order  Colored 
Noise  Addition  at  Off-Design  Flight  Condition 


Figure  6-15:  Power  Spectral  Density  Function  for  a  Second- 
Order  Colored  Noise  Process 


elsewhere  Is  sufficiently  high  to  achieve  the  desired  robustif ication. 


6.2.3  Discretized  Continuous-Time  LOG  Regulators  at  Design  Condition 

This  method  of  extending  the  robustification  techniques  to  discrete- 
time  systems  was  introduced  in  Section  2.7.1.  A  continuous-time 
controller  Identical  to  that  of  Sections  6.2.1  and  6.2.2  is  designed,  then 
discrete  controller  equations  are  formed  by  making  first-order  approxima¬ 
tions  to  the  discrete  controller  gain  matrices.  The  sample  rate  of  the 
discretized  controller  is  50  Hertz.  The  design  model  matrices  are  given 
in  Section  6.4. 

The  time  histories  of  the  mean  and  standard  deviation  of  0  for  the 
eight-state  controller  evaluted  against  a  truth  model  of  the  same 
dimension  are  shown  in  Figure  (6-17).  Again,  the  state  was  given  a 
perfectly  known  initial  condition  of  one  degree.  The  performance  of  the 
discretized  controller  is  very  similar  to  that  for  the  continuous-time 
case;  the  state  converges  to  zero  fairly  slowly.  This  similarity  is  as 
expected  since  the  sample  period  is  short  compared  to  natural  system 
transients.  Figure  (6-18)  shows  the  response  of  the  same  controller 
evaluated  against  a  twelve-state  truth  model  with  higher-order  actuator 
models.  As  can  be  seen,  changing  the  environment  in  which  the  controller 
is  evaluated  Introduces  a  slightly  larger  initial  overshoot  and  steady- 
state  error  in  the  mean  of  6  response.  Again,  the  unmodified  system  does 
not  display  good  robustness  properties. 

Figure  (6-19)  shows  the  response  of  the  same  controller  with  the 
filter  robustlfled  by  adding  a  white  noise  of  strength  q  -  1x10  6  to  the 
design  model.  The  Improvement  in  transient  time,  initial  overshoot,  and 


Figure  6— 18b t  Standard  Deviation  of  9  With  No  Noise  Addition 
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steady-state  value  Is  comparable  to  the  continuous-time  case  with  no 
noticeable  change  in  the  standard  deviation. 

The  results  of  applying  colored  noise  generated  by  a  first-order 
shaping  filter  are  shown  in  Figure  (6-20) .  The  overshoot  is  larger  than 
for  the  white  noise  addition,  and  there  is  still  a  slight  steady-state 
mean  error,  but  the  improvement  over  the  unrobustif led  case  is  still 
substantial. 

It  was  found  that  augmenting  second-order  shaping  filter  states  with 
the  design  model,  designing  a  continuous-time  controller,  than  discretiz¬ 
ing  the  concroller  produced  an  unstable  closed-loop  system  for  any  value 
of  Qu«  This  characteristic  was  not  observed  in  the  continuous- time  case. 

In  addition,  as  described  previously  in  Reference  21,  it  was  observed 

that  the  strength  of  the  white  and  colored  noise  could  not  be  adjusted 

arbitrarily  upwards.  It  was  found  that,  with  the  twelve-state  truth  model 

2  -6 
(T12,10,0.6) ,  q  and  could  be  adjusted  between  zero  and  1x10  ,  and 

the  robust  if  lcation  Improvement  was  similar  to  the  continous-tlme  case. 

However,  noise  intensities  beyond  this  value  (Qu  ■  2x10  **)  would  actually 

drive  closed- loop  system  eigenvalues  outside  of  the  z-domain  unit  circle. 

A  comparison  of  the  steady-state  values  of  the  standard  deviations 

of  the  aircraft  states  are  given  in  Table  (6-4) .  The  table  includes 
values  for  a  system  with  no  noise  addition,  white  and  first-order  colored 
noise  of  the  same  maximum  Intensity.  The  results  are  similar  to  the 
continuous-time  case.  It  is  seen  that  the  addition  of  white  noise 
increases  the  values  of  the  standard  deviations  of  the  states.  As  in 
the  previous  case,  colored  noise  addition  generated  by  a  first-order 
shaping  filter  did  not  yield  lower  standard  deviations  than  white  noise 
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Table  6-4 

Comparison  of  Steady-State  Standard  Deviations 
of  Aircraft  States  at  the  Design  Condition  for  a 
Discretized  Continuous-Time  System 


Ho  Noise 


White  Noise 


1st  Order 
Shaping  Filter 


2nd  Order 
Shaping  Filter 


a0 

8.877xlO~4 

5.035xl0“3 

9.645xl0~4 

5.310xl0-3 

1.005xl0-3 

5.821xl0-3 

Unstable 

Unstable 

Table  6-5 

Comparison  of  Steady-State  Standard  Deviations 
of  Aircraft  States  With  Higher-Order  Actuators 
For  a  Discretized  Continuous-Time  System 


No  Noise 


White  Noise 


1st  Order 
Shaping  Filter 


2nd  Order 
Shaping  Filter 


C0 

9.053xl0-4 

4.899xl0”3 

9.511xl0-4 

5.198xl0-4 

9.524xl0-4 

5 .212xl0-3 

Unstable 

Unstable 

addition  except  for  the  pitch  rate,  q.  Table  (6-5)  indicates  identical 

trends  for  the  case  where  higher-order  dynamics  are  included  in  the  truth 

model.  The  lower  maximum  noise  intensity  than  that  used  for  Table  (6-4) 

reflects  the  fact  that,  with  a  higher-dimension  truth  model,  the  closed- 

2 

loop  system  is  driven  unstable  for  a  lower  value  of  q  . 

Thus,  it  is  seen  that  the  desired  robustness  enhancement  can  be  gained 
by  adding  white  input  noise  to  the  system  model.  Time-correlated  noise  is 
not  appropriate  for  this  problem  because  it  does  not  yield  performance 
benefits  and  only  serves  to  increase  the  complexity  of  the  design  model. 


6.2.4  Discretized  Continuous-Time  LOG  Regulators  at  Off-Design  Condition 


Figure  (6-21)  demonstrates  that  the  system  exhibits  an  unstable 
response  when  the  flight  condition  is  changed  to  an  altitude  of  20000  fee 
and  a  Mach  number  of  0.6  (T12,20,0.6) . 

Again,  it  was  found  that  the  robustness  characteristics  could  be 

improved  with  the  injection  of  white  and  colored  noise  for  a  finite  range 

2  2 
of  q  and  Q^.  At  the  off-design  condition,  for  values  of  q  and 

beyond  2.5x10  5,  the  closed-loop  system  was  unstable. 

2 

The  response  of  the  system  with  the  maximum  value  of  q  is  shown  in 

Figures  (6-22a)  and  (6-22b) .  As  can  be  seen,  the  stability  has  been 

recovered,  indicating  that  the  full-state  feedback  system  was  stable. 

Thus,  by  the  addition  of  white  input  noise,  the  characteristics  approach 

that  of  a  full-state  feedback  controller.  Figures  (6-22c)  and  (6-22d) 

2 

show  that  stability  is  recovered  with  a  lower  value  of  q  .  Increasing 
it  beyond  this  value  changes  only  the  transients  of  the  mean  and  the 
magnitude  of  the  standard  deviation. 
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Figure  6-2  la:  Mean  of  0  With  Mo  Noise  Addition  at 
Off-Design  Flight  Condition 


Figure  6-2 lb:  Standard  Deviation  of  0  With  No  Noise  Addition 
at  the  Off-Design  Flight  Condition 


Figure  6-22a:  Mean  of  0  With  White  Noise  Addition  at 
Off-Design  Flight  Condition 


Figure  6-22b:  Standard  Deviation  of  0  With  White  Noise  Addition 
at  the  Off-Design  Flight  Condition 
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Figure  6-22c:  Mean  of  8  With  t-Jhite  Noise  Addition  at  an 
Off-Design  Flight  Condition 
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Figure  (6-23)  demonstrates  that  adding  colored  noise  generated  by  a 
first-order  shaping  filter  achieves  the  same  degree  of  robustness  enhance¬ 
ment  with  only  an  increase  in  the  initial  overshoot  of  9  compared  to  that 
of  Figure  (6-22a) .  The  steady-state  standard  deviations  of  Figures  (6-22b) 
and  (6-23b)  are  not  significantly  different. 

Augmenting  second-order  shaping  filter  states  with  the  system  model 
again  resulted  in  an  unstable  closed-loop  system.  For  any  non-zero  value 
of  Qu>  some  of  the  closed-loop  system  eigenvalues  were  driven  outside  the 


unit  circle  in  the  z-domain. 

Because  of  the  sensitivity  of  the  system  to  slight  changes  in  the 


strength  of  the  added  noise,  it  is  felt  that  this  method  is  inappropriate 

2 


for  this  problem.  The  range  of  admissible  values  for  q  and  Qy  is  very 
slight,  and  the  loss  of  closed-loop  system  stability  is  very  abrupt  when 
the  range  is  exceeded.  In  addition,  there  is  no  range  of  which  Improves 
the  robustness  characteristics  of  the  controlled  system  when  colored-noise 
generated  by  a  second-order  filter  is  added  to  the  model. 


6.2.5  Sampled-Data  LQG  Regulators  at  Design  Condition 

This  method  of  extending  the  robustification  techniques  to  sampled- 
data  systems  was  introduced  in  Section  2.7.2.  For  this  case,  the 
continuous-time  system  equations  are  discretized,  then  a  sampled-data 
Kalman  filter  and  controller  are  designed  from  the  onset. 

The  results  of  performance  analyses  for  the  sampled-data  controller 
with  a  sample  rate  of  50  Hertz  are  found  to  be  extremely  similar  to  those 
for  the  continuous-time  controller. 

Figure  (6-24)  shows  the  response  of  9  to  an  initial  condition  of  one 
degree.  This  is  the  result  of  a  performance  analysis  where  the  dimensions 
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Figure  6-23a:  Mean  of  0  With  First-Order  Colored  Noise 
Addition  at  Off-Design  Flight  Condition 
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Standard  Deviation  of  0  With  First-Order  Colored 
Noise  Addition  at  an  Off-Design  Flight  Condition 


of  the  truth  model  and  the  design  model  are  the  same  (Section  5.4).  As 
observed  previously,  the  mean  of  0  converges  slowly  to  zero.  Figure  (6-25) 
shows  the  response  of  the  same  controller  when  higher-order  actuator 
dynamics  are  Introduced  In  the  truth  model.  Again,  large  Initial  over¬ 
shoots  and  steady-state  mean  errors  are  Introduced.  The  unmodified  sampled- 
data  controller  does  not  exhibit  good  robustness  properties  when  certain 
states  are  Ignored  In  the  design  model. 

With  the  addition  of  white  Input  noise,  (as  described  In  Section 
2.7.2),  the  undesirable  characteristics  of  the  unrobustlfled  system  do  not 

appear  In  the  time  response.  This  is  shown  In  Figures  (6-26a)  and  (6-26b) . 

2 

Figures  (6-26c,d,e,f)  show  the  trend  for  a.higher  and  lower  value  of  q  . 

Increasing  the  magnitude  of  the  white  noise  changes  the  transient  mean 

response  and  the  magnitude  of  the  standard  deviation.  For  this  problem 

(where  the  evaluation  was  performed  using  the  truth  model  (T12, 10,0.6) , 

2  2 

In  the  range  of  values  of  q  that  were  examined  (0  _<  q  <  1) ,  the  dramatic 
Instabilities  observed  In  Sections  6.2.3  and  6.2.4  do  not  occur. 

Figure  (6-27)  demonstrates  that  nearly  identical  robustness  benefits 
can  be  gained  with  the  addition  of  colored  noise  generated  by  a  first- 
order  shaping  filter  as  with  a  white  noise.  However,  the  addition  of 
colored  noise  generated  by  a  second-order  shaping  filter  does  not  have 
the  fast  time  response  of  the  previous  two  cases,  as  shown  in  Figure 
(6-28).  Nonetheless,  the  steady-state  error  and  initial  overshoot  have 
been  substantially  improved. 

Table  (6-6)  makes  a  comparison  of  the  steady-state  values  of  all 
three  aircraft  states  at  the  design  condition  (truth  and  model  dimension 
equal)  for  cases  with  no  noise  addition,  white  noise,  and  first-  and 
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Figure  6-26a:  Mean  of  0  With  White  Noise  Addition 


Figure  6-26b:  Standard  Deviation  of  0  With  White  "oise  Addition 
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Figure  6-23a:  Mean  of  0  With  Second-Order  Colored  Noise  Addition 
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Figure  6-23b:  Standard  Deviation  of  S  With  Second-Order 
Colored  Noise  Addition 
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Comparison  of  Steady-State  Standard  Deviations 
of  Aircraft  States  at  the  Design  Condition 
For  A  Sampled-Data  System 


* 

°0 

°a 

°q 

No  Noise 

0 

8.712xl0“4 

5.036xl0**3 

1.206xl0“3 

White  Noise 

lxlO"4 

9.583xl0-4 

5.307xl0-3 

1.980xl0~3 

1st  Order 
Shaping  Filter 

lxl0-4 

1.002xl0“3 

1.842xl0-3 

1.765xl0”3 

2nd  Order 
Shaping  Filter 

21 

8.700xl0~4 

5.040xl0-3 

1.208xl0"3 

secord-order  colored  noise.  The  results  are  essentially  the  same  as  for 
the  continuous-time  controller.  The  same  trend  is  observed  in  Table  (6-7) 
where  higher-order  actuator  dynamics  are  Included  in  the  truth  model.  As 
in  the  continuous-time  case,  adding  white  noise  to  the  model  does  degrade 
the  performance  for  all  states  at  the  design  condition.  However,  when 
third-order  dynamics  are  included  in  the  truth  model,  white  input  noise 
decreases  the  standard  deviation  0.  When  the  filter  is  evaluated  in  an 
environment  other  than  the  design  condition,  adding  noise  can  improve 
the  filter  tuning.  Decreases  in  the  standard  deviations  appear  in  all 
states  for  second-order  colored  noise,  and  they  are  not  substantial  enough 
to  justify  the  added  complexity  of  the  design  model.  Thus,  the  Doyle  and 
Stein  technique  extended  to  a  sampled-data  system  provides  the  desired 
robustlfication  against  ignored  states  for  the  problem  considered  in  this 
thesis.  Significant  performance  benefits  are  not  gained  by  adding  time- 
correlated  noise  to  the  system  model  as  opposed  to  white  noise. 
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Table  6-7 


Comparison  of  Steady-State  Standard  Deviations 
Of  Aircraft  States  with  Higher-Order  Actuator 
Dynamics  For  A  Sampled-Data  System 


q2 

«u 

a0 

aa 

a 

q 

No  noise 

0 

- 

8.984xl0“4 

4.894xl0~3 

1.197xl0~3 

White  Noise 

- 

8.831xl0“4 

5.689xl0-3 

4.859xl0”3 

1st  Order 

Shaping  Filter 

lxlO-4 

9.311xl0-4 

5.815xl0‘3 

5.143xl0~3 

2nd  Order 

Shaping  Filter 

- 

21 

8.789xl0“4 

5.170xl0~3 

2.342xl0"3 

6.2.6  Sampled-Data  LOG  Regulators  at  Off-Design  Condition 

As  shown  in  Figure  (6-29) ,  the  response  of  the  system  is  unstable  at 

the  off-design  flight  condition  with  no  noise  addition. 

2  -4 

White  noise  addition  of  strength  q  -  1x10  ,  as  shown  in  Figure 

(6-30)  is  sufficient  to  recover  the  stability  of  the  system.  First-order 

colored  noise  of  the  same  maximum  intensity  produces  a  very  similar 

response,  as  shown  in  Figure  (6-31).  However,  second-order  colored  noise 

of  the  same  maximum  intensity  is  not  sufficient  to  recover  stability 

completely  as  demonstrated  by  the  divergence  of  the  standard  deviation 

-2 

in  Figure  (6-32) .  Increasing  the  maximum  noise  intensity  to  1x10 
achieves  the  desired  stability  characteristics  as  shown  in  Figure  (6-33), 
but  the  time  response  is  still  much  slower  than  for  the  previous  two 
cases . 

It  is  observed  in  Figures  (6-29)  through  (6-33)  that  all  three  types 


of  input  noise  substantially  improve  the  robustness  properties  of  the 


Figure  6-29a:  Mean  of  0  With  No  Noise  Addition  at  the 
Off-Design  Flight  Condition 
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Figure  6-29b:  Standard  Deviation  of  0  With  No  Noise  Addition 
at  the  Off-Design  condition 
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Figure  6-30a:  Mean  of  ©  With  White  Noise  Addition 
Off-Design  Flight  Condition 


Figure  6-30b:  Standard  Deviation  of  0  With  White  Noise 

Addition  at  the  Off-Design  Flight  Condition 
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Figure  6-3 la:  Mean  of  0  With  First-Order  Colored  Noise 

Addition  at  the  Off-Design  Flight  Condition 


Figure  6—3 lb :  Standard  Deviation  of  0  With  First-Order  Colored 
Noise  Addition  at  Che  Off-Design  Flight  Condition 


Figure  6-32a:  Mean  of  6  With  Second-Order  Colored  Noise  Addition 
at  the  Off-Design  Flight  Condition 


Figure  6-32b:  Standard  Deviation  of  0  With  Second-Order 

Colored  Noise  Addition  at  the  Off-Design  Flight  Conditic 


controlled  system  when  It  Is  subjected  to  changes  in  real-world  para- 
nV.\  meters.  The  improvement  due  to  the  addition  of  white  and  first-order 

colored  noise  is  very  similar.  This  indicates  that  even  at  the  off-design 
flight  condition,  the  design  model  is  still  fairly  adequate  at  low  fre¬ 
quencies  where  the  power  spectral  density  of  the  first-order  colored  noise 
is  low.  Robustness  can  also  be  enhanced  with  second-order  colored  noise 
to  a  lesser  degree  if  the  maximum  intensity  of  the  noise  is  sufficiently 
high.  As  in  the  continuous-time  case,  it  is  felt  that  this  effect  is 
partially  due  to  the  magnitude  of  the  noise  at  other  frequencies,  not  just 
the  peak  near  70  radians /second. 


6.3  Sampled-Data  FI  Controllers 


The  results  of  applying  the  Doyle  and  Stein  technique  to  a  sampled- 


data  PI  controller  were  inconclusive  for  this  problem.  However,  some 
results  are  presented  to  show  how  employing  a  Kalman  filter  to  estimate 


the  states  of  a  system  can  adversely  affect  stability. 

The  software  used  to  design  the  PI  controller  allows  the  design  of 
a  full-state  feedback  controller  or  one  with  a  Kalman  filter  in  the 
loop.  The  performance  analysis  program  then  generates  time  histories  of 
the  standard  deviation  of  the  states  both  with  and  without  a  filter. 


The  weighting  on  the  states,  controls  and  control  rates  are  defined 
in  Section  3.2.2  and  are  given  below: 
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Figure  6-35:  Standard  Deviation  of  0  at  Design  Condition 


The  weighting  matrices  specified  above  are  given  in  Reference  27. 

They  are  arrived  at  using  a  methodology  called  'implicit  model  following". 
As  mentioned  before,  the  software  used  to  design  PI  regulators  also 
includes  a  method  for  designing  a  Command  Generator  Tracker  to  specify 
feedforward  gains  that  cause  the  output  of  the  controlled  system  to  track 
the  output  of  a  command  model  in  which  the  desired  characteristics  of  the 
response  have  been  built  in  (damping  ratio,  overshoot,  settling  time,  etc.) 
Implicit  model  following  can  be  used  to  affect  the  feedback  gains  of  the 
PI  controller  in  a  way  that  makes  the  controlled  system  more  robust.  A 
more  detailed  explanation  of  implicit  model  following  is  given  in 
References  27  and  29. 

Figure  (6-34)  shows  the  time-response  of  the  full-state  feedback 
system  with  an  initial  condition  of  one  degree  on  0  evaluated  against  a 
deterministic  truth  model  of  the  same  dimension.  It  is  seen  that  the 
response  has  very  nice,  well-damped  second-order  characteristics.  Figure 
(6-35)  demonstrates  the  standard  deviations  for  this  controller  in  a 
stochastic  environment  are  very  similar  with  and  without  a  filter  in  the 
loop.  The  design  model  is  defined  in  Section  5.4.  In  Figure  (6-36), 


Figure  6-36:  Standard  Deviation  of  0  Evaluated 

Against  Third-Order  Actuator  Dynamics 


the  results  of  the  performance  analysis  are  shown,  where  the  eight-state 
controller  was  evaluated  against  a  truth  model  with  higher  order  actuator 
dynamics  in  the  truth  model.  It  is  seen  that  without  full-state  feedback 
stability  was  lost.  The  results  are  the  same  at  an  off-design  condition 
(T12,20,0.6)  as  shown  in  Figure  (6-37).  Thus,  the  figures  demonstrate 
that  when  actuator  states  are  Ignored  in  the  design  model,  a  full-state 
feedback  controller  exhibits  good  stability  robustness  properties.  How¬ 
ever,  once  a  filter  is  inserted  into  the  loop,  these  properties  are  lost. 
Attempts  were  made  to  recover  the  stability  of  the  controlled  system 

by  applying  the  Doyle  and  Stein  technique.  It  was  found  that  any  non- 
2 

zero  value  of  q  only  made  the  standard  deviations  diverge  more  rapidly. 
This  was  true  for  both  flight  conditions. 

Recall  that  the  Doyle  and  Stein  technique  was  applied  to  sampled- 
data  LQG  regulators  by  modifying  the  matrix  as  follows: 

Qd(q)  *  Qdo  +  l2*™1**  <6"6) 

using  the  B  matrix  of  the  continuous-time  system  equation. 

The  technique  was  applied  to  sampled-data  PI  controllers  with  the 
equation 

vq)  -  «do +  ’W74'  (6-7) 

using  the  Bd  matrix  of  the  equivalent  discrete-time  system  equation. 

The  Doyle  and  Stein  technique  was  derived  by  equating  the  return- 
difference  mappings  for  a  full-state  feedback  system  and  a  filter-based 
system.  The  derivation  was  based  on  the  controllers  being  a  full-state 


feedback  regulator  and  an  LQG  regulator.  It  was  expected,  since  the 
Kalman  filter  is  the  same  for  LQG  regulators  and  PI  controllers,  that  at 
least  some  robustness  enhancement  could  be  obtained  by  directly  applying 
the  technique  to  a  PI  controller.  However,  this  was  not  found  to  be  true. 

6.4  Summary 

This  chapter  has  presented  the  results  of  applying  two  techniques  to 
improve  the  robustness  properties  of  a  controlled  system.  The  two  methods 
examined  are  the  techniques  of  inputting  stationary  white  or  time- 
correlated  Gaussian  noise  into  a  system  model  during  the  process  of  tuning 
the  Kalman  filter. 

Two  separate  issues  of  robustness  were  examined.  The  first  was  the 
idea  of  robustifying  a  controller  so  that  instabilities  do  not  occur  when 
states  are  ignored  in  the  controller  and  Kalman  filter  design  model.  For 
this  thesis,  the  problem  considered  was  an  aircraft  flight  control  problem 
and  the  effect  of  ignoring  states  that  described  the  actuator  dynamics 
was  examined.  In  this  particular  instance,  the  design  model  misrepresenta¬ 
tion  was  confined  to  a  particular  portion  of  the  frequency  spectrum; 
this  specifically  motivated  investigation  of  adding  time-correlated  rather 
than  white  noise  for  robustlflcation. 

The  second  robustness  issue  was  the  idea  of  robustifying  a  controller 
against  changes  in  the  real-world  parameters  upon  which  the  controller 
design  was  based.  Here  the  designed  model  misrepresentation  was  not 
confined  to  only  a  particular  band  of  frequencies. 


The  primary  result  of  this  chapter  is  that  the  stability  robustness 
of  the  controlled  system  can  be  substantially  enhanced  by  applying  both 


VII.  Conclusions  and  Recommendations 


The  robustlf ication  of  LQG  regulators  by  Inputting  white  noise  or  time- 
correlated  noise  generated  by  a  first-order  shaping  filter  Into  the  system 
model  did  work  well  for  all  three  applications  of  the  controllers  examined 
(continuous,  discretized,  sampled-data) .  In  addition,  time-correlated  noise 
generated  by  a  second-order  shaping  filter  Improved  the  controller's  robust¬ 
ness  properties  to  a  lesser  degree  for  the  continuous- time  and  sampled- 
data  case.  For  the  discretized  case,  this  method  produced  Instabilities  in 
the  response  of  the  system  and  could  not  be  used. 

It  was  noted  that  in  Chapter  VI  that  few  performance  benefits  were 
gained  by  using  time-correlated  noise  as  opposed  to  white  noise  for  the  pro¬ 
blem  considered  in  this  thesis.  It  is  felt  that  the  range  of  frequencies 
where  the  design  model  differed  from  the  chosen  representation  of  the  real- 
world  was  not  sufficiently  narrow  in  this  case  to  result  in  performance 
benefits.  Greater  performance  benefits  may  be  realized  by  examining  the 
application  of  colored  noise  addition  to  problems  such  as  gust-load  allevia¬ 
tion,  flutter  suppression,  or  aeroelastic  effects  such  as  including  first- 
and  higher-order  bending  modes  in  the  truth  model  representation  of  the 
real  world. 

It  is  felt  that  the  robust if ication  techniques  for  LQG  regulators 
were  examined  in  great  detail  in  this  thesis.  However,  the  extension  to 
PI  controllers  was  only  touched  upon,  and  the  Doyle  and  Stein  technique 
was  applied  unsuccessfully.  To  examine  this  more  thoroughly,  it  is 
suggested  that  the  Doyle  and  Stein  technique  be  applied  more  directly  to 
PI  controllers.  That  is,  the  conditions  analogous  to  those  of  Doyle  and 
Stein  that  would  make  the  return-difference  mapping  asymptotically  equal 


for  a  full-state  feedback  controller  and  a  filter-based  PI  controller 


should  be  derived. 

The  technique  of  injecting  time-correlated  noise  into  the  system 
model  for  a  PI  controller  was  not  examined  in  this  thesis.  The  existing 
software  was  not  originally  designed  to  allow  augmenting  of  states  with 
the  design  model.  Therefore,  it  would  be  difficult  to  augment  shaping 
filter  states  to  allow  for  colored  input  noise.  The  modifications  shown 
in  Appendix  C  were  made  so  that  a  few  cases  of  colored  input  noise  could 
be  examined  quickly.  If  an  extensive  study  were  made,  the  awkwardness  of 
these  modifications  would  become  apparent.  To  examine  all  of  the  robust- 
ification  techniques  discussed  in  this  thesis  would  thus  require  additional 
software. 

It  has  been  mentioned  that  a  drawback  of  adding  colored-noise  to  a 
system  model  is  that  it  adds  states  to  the  Kalman  filter  model.  An 
alternative  method,  called  residualization  (Ref  28),  reduces  the  order  of 
the  model  back  to  that  of  the  original  system  before  the  shaping  filter 
states  were  added.  It  would  be  useful  to  examine  this  implementation  and 
compare  it  to  the  performance  of  the  implementation  used  in  this  thesis 
for  a  problem  where  colored  input  noise  is  appropriate. 

Finally,  as  noted  in  Sections  6.2.3  and  6.2.4,  the  technique  of  add¬ 
ing  white  or  colored  noise  to  a  continuous-time  controller,  then 

discretizing  the  controller  only  improved  robustness  characteristics  for 

2 

a  finite  range  of  q  or  Q^.  Beyond  that  range,  the  closed-loop  system 
was  unstable.  This  phenomenon  is  not  well  understood,  and  further 
research  would  be  warranted  to  determine  why  this  occurs.  While  it  is  not 
expected  that  an  extension  of  the  Doyle  and  Stein  method  would  have  all 


167 


the  same  characteristics  of  the  original  technique,  it  would  be  use¬ 
ful  to  determine  what  occurs  during  the  discretization  process  to  drive 
closed-loop  system  poles  outside  the  z-domain  unit  circle  so  abruptly. 

The  results  of  the  previous  chapter  have  thus  demonstrated  that  the 
techniques  considered  can  substantially  improve  the  robustness  properties 
of  a  controlled  system.  For  the  particular  problem  considered  white 
noise  added  to  the  system  model  at  the  control  entry  points  is  the 
appropriate  method  for  accomplishing  the  robustification 
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APPENDIX  A:  Generic  Controller  Format 

A1 .  Introduction 

In  Chapter  II,  the  idea  of  a  standard  format  for  a  linear  control¬ 
ler  was  introduced.  The  format  is  particularly  useful  in  that  any  LQG 
controller  synthesized  by  LQG  methods  can  be  rearranged  into  the  standard 
form.  Subsequently,  the  performance  analysis  equations  presented  in 
Chapter  II  apply  to  any  controller  put  in  the  "generic"  form,  not  just  LQG 
regulators. 

This  appendix  defines  explicitly  the  generic  form  controller 
equations  for  the  types  of  controllers  considered  in  this  thesis.  In  the 
first  section,  the  continuous-time  LQ  regulator  is  examined,  that  is,  a 
full-state  feedback  regulator  with  a  control  law  expressed  as: 

u*(t)  -  Gc*  x(t)  (A- 1 ) 

The  full- state  feedback  generic  structure  is  presented  because  it  is 
desired  to  recover  the  robustness  characteristics  of  the  LQ  controller 
with  the  addition  of  input  noise  as  covered  in  Chapters  II  and  IV. 

Then,  the  continuous -time  LQG  regulator  is  presented,  based  on  a 
control  law  that  employs  state  estimates  from  a  Kalman  filter: 

vi*(t)  -  -Gc*  x(t)  (A-2) 

Next,  the  structure  of  a  sampled-data,  full-state  feedback  regulator 
is  examined  with  a  control  law  expressed  as 


Two  forms  of  a  sampled-data  LQG  regulator  are  examined.  The  first 
is  based  on  the  optimal  control  law  given  by 

u*(t.)  -  -G  *  x(t.+)  (A-4 

—  i  c  —  1 

The  second  is  based  on  the  subopt imal  control  law 

u*(t.)  ■  -G  *  x(t.  )  (A-5 

—  1  c  —  i 

In  the  last  two  sections,  the  format  is  presented  for  a  sampled- 
data  PI  controller  designed  on  the  basis  of  LQG  methodology.  First,  the 
full-state  feedback  case  is  considered,  then  a  Kalman  filter  is  used  to 
provide  state  estimates. 

A. 2  Continuous- time  Controller  Generic  Structure 

The  generic  format  desired  for  the  controllers  considered  in  this 
thesis  is  given  by 

u*(t)  -  Gcx  x^t)  +  Gcz  £(t)  +  Gcy  ^(t)  (A-6) 

Xc(t)  -  Fc  J^Ct)  +  Bcz  z(t)  +  Bcy  ^(t)  (A-7) 

which  takes  the  form  of  an  algebraic  relation  for  the  optimal  control,  u(t) 
and  a  propagation  equation  for  the  controller  states.  The  controller 
states,  x  (t),  are  defined  for  the  particular  type  of  controller  considered 
and  z(t)  and  are  measurements  and  desired  values  of  controlled 

variables,  respectively. 

For  the  full-state  feedback  case,  perfect  measurements  of  the 


states  are  available,  i.e.. 


and  Thus,  it  is  seen  by  comparing  Equations  (A-l)  and  (A-6) 


G  -  0 
cx 


(A-9) 


G  «  -G 
cz  c 


(A- 10) 


G  =0 
cy 


(A-l l) 


In  this  instance,  there  are  no  internal  controller  states,  so  Equation  (A-7) 
is  not  maintained. 

For  an  LQG  regulator,  ^j(t)  *s  a8a*-n  zero,  therefore  G  and  B 

can  be  set  to  zero.  The  controller  states  are  defined  to  be  the  condi¬ 
tional  mean  estimates  from  a  Kalman  filter,  x(t).  By  the  certainty 
equivalence  principle,  x(t)  in  Equation  (A-2)  can  be  replaced  by  x(t) 
which  are  now  the  controller  states,  x  (t): 


u  (t)  -  -Gc  ^(t) 


(A- 12) 


Comparing  Equations  (A-6)  and  (A— 12) ,  it  is  seen  that 


(A- 13) 


G  -  -G 
cz  c 


(A- 14) 


Recall  that  the  continuous-time  Kalman  filter  equation  yields  an  estimate 
of  the  states,  ft(t),  where  fc(t)  is  now  defined  as  the  controller  states, 
x^t).  This  is  given  by 


i  (t)  -  F  x  (t)  +  Bu* ( t )  +  K[z(t)  -  H  x  (t)| 

— c  — c  —  l—  — C  J 


(A- 15) 


Substituting  Equation  (A- 12)  into  the  above  and  rearranging  yields 

x  (t)  =  [ F  -  BG  *  -  KH  1  x  (t)  +  K  z(t) 

— c  l  c  J  — c  — 

Comparing  Equations  (A-7)  and  (A— 16),  it  is  seen  that 

Fc  "  [F  "  BGc*  ‘  H 


B  -  K 
cz 


A. 3  Optimal  Sampled-Data  Generic  Controller  Structure 


The  generic  structure  of  Equations  (A-4)  and  (A-5)  is  given  in 
sampled-data  form  by 


i  (ti>  -  Gc*  *  °«  l(ci>  *  Gcy  2d(ti)  (A-'9) 


‘  Gc  icUi)  *  Gcz  £(ti>  *  GCy  Zd<tl)  <A-20) 

It  is  easily  scon  that  for  a  sampled-data  full-state  feedback 

regulator,  the  generic  form  is  identical  to  Equations  (A-9)  through  (A— 11). 

For  the  optimal  LQG  regulator,  the  actual  state  values  are  replaced 

by  estimates  just  after  measurements  are  taken  at  the  sample  times. 

Again,  Vj(c)  be  zero  for  a  regulator,  therefore  G  and  B  can  be 

*<i  cy  cy 

A  — 

set  to  zero.  Define  the  controller  states  to  be  x(t^),  the  state  estimates 
just  prior  to  a  measurement  update.  The  Kalman  filter  propagation  and 
update  relations  for  the  estimates  of  the  states  are  given  by 


*(ti+])  -  ^xCt^)  +  Bd  u\t.) 


(A-2 1 ) 
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i(t.  )  *  [T  -KH  J  >  +  KzCt^  ( 

Replace  ac( t .” )  by  x  (t.)  and  substitute  (A-22)  into  (A-4)  to  yield 

—  1  — C  1 

U*(t£)  -  -G*  [  I-KH  ]  xc(ti)  -  Gc*  Kz(t.)  ( 


(A-22 


(A-23 


Comparing  (A-19)  and  (A-23),  it  is  seen  that 


G  -  -G„  I-KH 
cx  c 


(A-24 


G  -  -G  K 
cz  c 


(A-25 


Now  substitute  Equations  (A-4)  and  (A-22)  into  (A-21),  replacing  x^(t^-) 


with  ac  ( t  - )  : 
•<  i 


Ic<V>  -[*  -  Vc*  ]  I1  ■  KH  ]  2c(ti> 
♦[♦  -  Vc*  1  *  £<ti> 


(A-26 


Comparing  (A-20)  and  (A-26),  it  is  seen  that 


♦c  "I*  -  Vc*  ]  I  ] 
"cc  -[*  -  Vc*  ]  K 


(A-21 


(A-2( 


A. 4  Sub-optimal  Sampled-Data  Generic  Controller  Structure 


For  the  suboptimal  control  law,  where  the  state  values  are  replaced 
by  estimates  just  prior  to  the  sample  times,  the  controller  states  are 
defined  to  be  $(t.”).  The  output,  ^(t^,  zero,  thus  Gcy  and  Bcy  can  be 
set  to  zero.  By  direct  comparison  of  Equations  (A-5)  and  (A-29),  it  is 


seen  that 


V 


Now  substitute  Equation  (A-5)  and  (A-22)  into  (A-21),  replacing  x(tj-) 


by  x  (t.)»  to  yield 

“"C  X 


:<'!♦,)  ’  U[l-KH]  -  BdGc‘>  x,.^) 

+  [  (t>K  J  zCtj) 


(A-3 1 


Thus,  by  comparing  Equations  (A-20)  and  (A-31),  it  is  seen  that 


4)c  -  (4>  [l-KH  ]  -  BdGc*> 


(A-3  2 


(A-32 


led-Data  PI  Controller  Generic  Structure 


An  equivalent  form  for  the  PI  control  law  derived  in  Chapter  III 
which  achieves  Type-1  control  is  given  by  (Ref  1;23). 


u  (t.)  -  -K^  xitL)  +  Kz  j^tj)  +  Kz  ^(tj) 


(A-34) 


where  £(t^)  are  termed  the  pseudo- integral  states  and  are  expressed  as 


i(tui>  i>  *  (id<ti)  -r<ti)] 


(A-35) 


For  the  PI  controller,  a  non-zero  output,  will  be  allowed,  where 

£(t^),  the  actual  output  of  the  system,  is  given  by 


(A-36) 


^(t^)  «  Cat ( C  ^  )  +  Dy  u  (c^ 

For  Che  full-sCate  feedback  case,  Che  conCroller  scaces  are  defined 
Co  be  SubsCiCuCing  (A-35)  and  (A-36)  inCo  (A-34)  and  recalling 

ahac  x(c.)  ■  £(c^)  yields 


u  (tj)  -  K^Uj)  -  K^tj)  *  K^le.) 


(A-37) 


Comparing  Chis  equacion  (A- 19),  ic  is  seen  ChaC 


Gcx  -  Kz 


(A-38) 


G  -  -K 

CZ  X 


(A-39) 


1 


,v 

i 


G  -  K 
cy  z 


(A-40) 


Then,  by  subscicuCing  Equacions  (A-34)  and  (A-36)  inCo  (A-35)  wich 
xc(ci)  -  £(4): 


I1*0/*  ]2d<‘i> 


(A-4  1) 


;■> 

■A 


and  comparing  Chis  Co  Equacion  (A-20)  yields 


B 


"  I C"DyK* I 

■  h-vJ 
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(A-4 2) 

(A-43) 

(A-44) 


'  A 

tf’ 

k/v.  • 


Next,  substitute  Equations  (A-22)  and  (A-36)  into  (A-35)  to  yield 


--[c  -  V*|[I-KH1 

*  [  M^I  ]  Sf'l*  *|C  '  V*  1  K  -  ti)  <A_49) 

*  [  l'DyKz  I  2d(ti> 


Equations  (A-47)  and  (A-48)  in  terms  of  the  controller  states,  x  (t.), 

— C  1 


are  given  by 


* ,  \ 
u  ( t .) 


[-Kx{X-KH>|  Kzj£c(ti) 

[V  1  *<*l>  *  Kz  Zd(ti) 


f  I 

It:  v. 

iHa! 


(A-50) 


[♦  -  ¥,| 
-|c-VJk 


£(ti>  + 


fl-D  K 
l  y  z 


(A-5 1 ) 


Comparing  Equations  (A- 19)  and  (A-50),  and  (A-20)  and  (A-51),  it  is  seen 


G  -  [  -K  {I-KH}  !  K  1 
cx  lx1  I  Z  J 

G  -l-K  k] 

CZ  I  X  j 


(A-52) 


(A-53) 


-  W 
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APPENDIX  B:  Modifications  and 
Additions  to  LQGRP 


A. 1  Introduction 

This  appendix  is  Intended  to  be  used  as  a  supplement  to  Reference 
21,  Appendix  D, which  is  the  user's  guide  to  a  program  entitled  Linear 
Quadratic  Gaussian  Regulator  Performance  (LQGRP) .  The  program  provides 
the  capability  of  designing  and  evaluating  the  performance  of  continuous- 
time  and  sampled-data  LQG  regulators.  In  addition,  it  contains  options 
of  enhancing  the  robustness  of  both  types  of  regulators  via  the  Doyle  and 
Stein  technique. 

Three  types  of  changes  are  made  to  the  original  program  which  are 
documented  herein.  The  first  type  involves  corrections  to  errors  in  the 
original  source  code.  The  second  type  entails  modifications  that  result 
in  more  convenient  input  and  output  and  a  more  efficient  program.  The 
third  type  of  change  generates  additions  so  that  the  technique  of  inject¬ 
ing  time-correlated  noise  into  the  design  model  while  tuning  the  Kalman 
filter  for  robustness  purposes  can  be  applied  to  LQG  regulators. 

Corrections  to  the  original  source  code  (contained  on  subsequent 
pages)  are  bracketed  and  marked  with  a  "C".  Modifications  are  bracketed 
and  marked  with  an  "M",  and  additions  are  bracketed  and  marked  with  an 
"A". 

A.  2  Corrections  to  LQGRP 

The  first  correction  appears  on  line  6770.  The  variable  name  IRF2 
replaces  IRFM  in  the  original  code.  IRFM  is  the  dimension  of  the  design 
model  F  matrix,  but  what  should  be  passed  to  the  subroutine  is  the 


dimension  of  F  minus  the  number  of  deterministic  states,  which  is  IRF2. 


Next,  on  line  15330,  1CBM  (the  column  dimension  of  the  model  B 
matrix)  replaces  IRFM  in  the  second  argument  of  the  subroutine  MAT3. 

A  third  correction  is  made  in  lines  17120  and  17130.  The  original 
source  code  contains  extra  arguments  in  the  call  to  subroutine  DDTCON. 

They  do  not  interfere  with  execution  of  the  program,  but  they  are  not 
needed  and  have  been  deleted  in  this  version. 

In  line  19430,  BM  (IDS,  IDS)  (starting  address  of  the  design  model 
B  matrix  after  deterministic  states  are  deleted)  replaces  BM  in  the 
original  program.  It  is  intended  to  pass  to  the  subroutine  only  the  lower 
portion  of  the  design  model  B  matrix,  BM,  after  the  deterministic  states 
(listed  first)  are  deleted.  The  original  program  passes  the  entire  B 
matrix.  Making  this  correction  changes  the  starting  address  of  the  array 
in  subroutine  DAS2  so  that  only  the  desired  portion  of  BM  is  used. 

Lines  19500  and  19510  are  inserted  into  the  program  to  correct  an 
error  in  line  19520.  Originally,  RMD  appears  in  place  of  WM4.  RMD  is 
the  discrete-time  measurement  noise  covariance  matrix.  However,  the  sub¬ 
routine  KFLTR  requires  a  vector  containing  the  diagonal  elements  of  RMD. 
Thus,  the  diagonal  elements  of  RMD  are  stored  in  the  first  column  of  UM4 
in  lines  15900  and  19510,  and  WM4  is  passed  to  the  subroutine  instead  of 
RMD.  WM4  is  a  work-space  array  not  originally  being  used  at  that  point 
in  the  program. 


The  last  correction  is  made  to  line  20840.  Originally,  the  line 
read  call  MAT3,  which  calculates  the  transpose  of  the  desired  result. 
This  is  corrected  by  replacing  it  with  CALL  MAT3A. 


B.3  Modifications  to  LOGRP 


The  matrices  and  vectors  defined  in  lines  370  through  510  were 
originally  of  dimension  5  or  10.  All  matrices  and  vectors  of  dimension 
5  are  changed  to  13,  and  those  of  dimension  10  are  changed  to  26.  This 
change  is  reflected  also  in  lines  680  through  700.  This  allows  the  num¬ 
ber  of  states  in  the  truth  or  design  model  to  be  a  maximum  number  of  13. 

The  original  version  of  LQGRP  had  6  input /output  options  for  entering 
and  printing  out  truth  and  design  model  matrices .  The  version  listed 
herein  has  7.  The  first  2  options  are  unchanged.  Option  3  now  allows 
the  user  to  change  as  many  elements  of  a  specified  matrix  as  desired  by 
listing  the  row,  column  and  value  of  the  element  being  changed.  When 
the  user  enters  a  0,  the  program  exits  this  option.  Options  4  and  5  are 
also  unchanged.  Option  6  initially  zeros  the  entire  array  and  then 
allows  the  user  to  enter  as  many  elements  as  desired  by  entering  the  row, 
column  and  value  of  each  element.  Entering  a  0  will  exit  this  option. 
Option  7  takes  the  place  of  option  6  in  the  previous  version.  Thus,  on 
a  first  run  through  the  program,  option  6  initializes  the  array  to  zero 
and  then  only  non-zero  elements  need  to  be  entered.  On  subsequent  runs, 
changes  can  be  made  to  any  vector  or  matrix  by  using  option  3. 

The  changes  discussed  above  require  that  modifications  be  made  to 
subroutines  MVEC10  and  MMAT10,  which  control  the  programs  input  and  out¬ 
put.  These  are  listed  in  lines  12370  to  12380,  12460  to  12530,  12590, 
13060,  13130  to  13230  and  13280. 

The  program  stores  results  of  the  performance  evaluation  routines 
to  four  data  files  for  plotting.  These  data  files  contain  the  time 
histories  of  the  following  vectors  and  matrices,  defined  in  Section  2.3: 


x  (t),  P  _  (t),  u(t)  and  P  (t) .  The  modifications  listed  in  lines 
—a  x  x  —  uu 

a  a 

10650  and  10690  calculate  and  store  the  square  roots  of  the  diagonal 

elements  (standard  deviations)  of  P  (t)  and  P  (t)  rather  than  storing 

a  a  uu 

the  diagonal  elements  (variances) .  This  change  also  occurs  in  lines 

11570  and  11600.  Notice  in  lines  11560  through  11660  that  only  the  first 

7  states  of  x^(t)  and  the  upper  left  (7x7)  partition  of  Px  x  (t)  ^  stored 

a  a 

for  plotting.  This  is  an  option  of  the  user.  Any  portion  of  the  vector 

and  matrix  may  be  stored  by  changing  the  7  in  lines  10630,  10770,  11550, 

11610  and  11650  to  the  desired  value  or  to  IREM  (the  dimension  of  the 

design  model  F  matrix)  if  the  entire  vector  and  matrix  are  desired. 

The  four  vectors  and  matrices  listed  above  are  printed  to  the 

terminal  during  execution  of  the  program.  Currently,  only  the  first  3 

states  of  x  (t)  and  the  upper-left  (3x3)  partition  of  P  (t)  are 

a  a 

printed.  Any  portion  may  be  printed  by  changing  the  3  in  lines  10530  and 
10570  to  a  desired  value  or  to  IRFM  if  the  entire  vector  and  matrix  are 
desired.  Note  that  all  of  u(t)  and  P^u(t)  are  stored  and  listed  at  the 
terminal. 

The  preceding  modifications  were  made  to  LQGRP  to  make  the  program 
more  convenient  to  use  in  conjunction  with  the  problem  considered  in  this 
thesis.  None  are  necessary  for  execution  of  the  program,  as  contrasted 
to  the  corrections  of  Section  B.2. 

B.4  Additions  to  LQGRP 

This  section  describes  the  additions  necessary  to  the  program  so 
that  the  technique  of  injecting  colored  noise  into  the  design  model 


during  filter  tuning  may  be  applied.  The  changes  are  primarily  lines  of 

code  Inserted  Into  the  program.  However,  a  few  lines  of  the  original 

source  code  are  altered  slightly,  and  these  will  be  mentioned. 

For  a  continuous-time  system,  the  Input  prompt  for  colored  noise  Is 

given  in  line  13870.  If  colored  noise  is  not  desired,  the  program  skips 

to  line  13920  and  continues  execution.  Note  that  line  13920  Is  from  the 

original  program  with  the  label  2900  inserted  in  front.  If  colored  noise 

is  desired,  the  dimension  of  the  model  F  matrix,  IRFM,  is  stored  in  a 

dummy  variable,  IHOLD,  for  later  use.  Then,  in  line  13910,  subroutine 

CNOISE  is  called,  which  controls  the  augmentation  of  shaping  filter  states 

with  the  original  design  model. 

Lines  13950  through  14020  augment  zeros  to  the  deterministic 

* 

controller  gain  matrix,  ,  if  the  colored-noise  options  are  executed. 
Lines  13950  and  13960  are  from  the  original  source  code,  altered  by  re¬ 
placing  IRFM  with  IHOLD.  Recall,  as  discussed  in  Section  4.3,  that 

Gc*  is  calculated  using  the  design  model  of  the  unaugmented  system,  and 

* 

the  dimensionality  difference  is  taken  care  of  by  augmenting  Gc  with 
the  appropriate  number  of  columns  of  zeros. 

For  a  sampled-data  system,  the  colored  noise  input  prompt  should 
appear  between  lines  16710  and  16720.  It  is  missing  from  this  listing, 
but  should  read 

WRITE  (KOUT,*)  ’COLORED  INPUT  NOISE  (Y  OR  N)>' 

Lines  16720  through  16760  then  control  whether  the  colored-noise  routines 
are  executed.  Line  16760  is  from  the  original  program  with  a  label  25 


Inserted . 


On  line  17090,  IRFM  is  again  replaced  by  1H0LD.  Lines  17120  and 
17130  are  also  from  the  original  program  with  an  additional  argument, 

IHOLD,  in  the  parameter  list.  Then,  lines  17140  through  17190  check  to 

* 

see  if  the  colored-noise  routines  were  executed.  If  so,  G  is  augmented 

c 

with  the  appropriate  number  of  columns  of  zeros. 

In  both  the  continuous-time  and  sampled-data  case,  it  is  desired  to 
use  the  original  design  model  for  controller  gain  calculations,  as  men¬ 
tioned  above,  in  subroutines  CDTC0N  and  DDTCON,  which  calculate 
deterministic  controller  gains  for  the  continuous-time  and  sampled-data 
case,  respectively.  These  subroutines  are  essentially  unchanged  except 
that  IHOLD  is  substituted  for  IRFM  where  indicated  in  CDTCON  (lines  5110 
through  5890).  In  DDTCON,  IHOLD  is  an  additional  parameter  in  the 
argument  list  and  replaces  IRFM  where  indicated  (lines  20480  through 
21030) . 

Lines  24770  through  24930  contain  subroutine  CNOISE  which  controls 
what  type  of  shaping  filters  are  augmented  to  the  design  model.  An 
input  prompt  asks  if  a  first-  or  second-order  shaping  filter  is  desired. 
Subroutine  FORDER  is  called  (lines  24940  through  25510)  if  a  first-order 
shaping  filter  is  desired.  If  a  second-order  filter  is  desired,  then 
subroutine  SORDER  is  called  (lines  25520  through  26160) .  Both  subroutines 
prompt  for  the  shaping  filter  design  parameters  described  in  Chapter  IV. 
Then,  the  design  model  is  augmented  with  the  shaping  filter  states  and 
appropriate  partitions  of  the  augmented  matrices  are  zeroed.  Finally, 
the  dimensions  of  the  design  model  F  and  G  matrices  are  altered  to 
reflect  the  higher  dimension  after  augmenting. 

The  matrices  described  above  thus  modify  LQGRP  so  that  shaping  filter 
states  can  be  augmented  with  the  original  system  design  model.  It  should 


be  noted  that  the  program  will  still  ask  If  modification  via  the  Doyle 
and  Stein  technique  is  desired  if  the  colored-noise  options  are  chosen. 
Either  the  colored-noise  options  or  the  Doyle  and  Stein  options  may  be 
chosen,  but  not  both. 

Additionally,  it  is  desirable  to  have  the  original  design  and  truth 
models  stored  on  Tape  8  (Ref  21)  so  that  they  can  be  read  into  the  pro¬ 
gram  via  input  option  18.  When  the  colored-noise  options  are  chosen,  the 
design  model  is  altered.  Thus,  to  make  subsequent  runs  through 
LQGRP,  the  original  design  and  truth  models  must  be  read  back  in. 


PRCGRA**  i.TG-.o  (OUTPUT?*,.  ,TAPE*sC"TeuT.TAPE:cs*.,T.,eE;3s6.., 
iT*.P£i-  ,  TiO"l£  *5-,  Inputs*.  ,TAO£1C®:sPUT,T4P£  j  =  t»,TA=£7» 

This  <»-.C«iRAM  PERFORMS  i  F£Pr  5RNAME  ANALYSIS  PC-  T-c  »:n?A-  CUiO'ATI 
GAUSSIAN  C3f«T  <iCLu£“S  CESTRISEO  B  Y  SOI  /OTsFX  »9U*Gh  hnO  A  QUADRATIC 
COST  FUNCTION,  IP  9IcF£R£NT  CONTROL  ALGORITHMS  A'£  SUPPLIED  TNE 

PS35W1  bILL  STILL  OC  A  ?ERF— .KANCE  ANALYSIS.  THE  hETOHCOOcOGY  IS 
3AS£0  ON  THE  P£RP  ANAL.  SECTION  IN  CHAPTER  1%  CP  a.  S.  MAtBSCKS 
TO  3£  PUo»:SH£D  VO„Um£  2  OF  STCCH,mOOElS,£ST  AND  CONTROL 

~MANY  OF  THE "SUBROUTINES  USEO  FCS'V'ATRIX  MANIPULATION  COME  FROM  THE 
ROUTINES  COMPILED  BY  0.  KLIENMAN(TR-75— ,  ONR  CONTRACT  • 
N30014-75-C1357) 

IN  THE  FOLLOWING  PRO  GRAH  “TRUTH'l'C'OEL  “hats  ICES  ARE  TbC  LETTERS  WITH 
THE  LAST^uETTER  BEING  -T-  .  CONTROLLER  MODEL  HATRICES  ARE  TWO 
"LETTERS  ENOING  IN  -H-.  -T-  FOLLOWING  APARTICU.AR  **ATR  IX  NAME 

INDICATES  THE  MATRIX  IS  TRANSPCSSO.  -I-  FOLLOWING  A  PARTICULAR 
MATRIX  NAME  INDICATES  THE  INVERSE  OF  THE  HATRIX 

COHMON  BlOCKS_  MAINl  ,MAIN2,INCU  A-*E  REQUI6S0  RY  TH?  KLiEMAN  ROUTINES 
KLIENHAN  ROUTINE  -GAT  10-  S=CUIRES  A  BLANK  CARO  TC  ENO  THE  READ* 
——INPUT  F.-.OM  TAPElC  -—-OUTPUT  TO  TAPEll 


CHARACTER  MSG»6u,0SCRPT*6:  __  ___ 

REAL  FT  (13 ,13), 6T (13^13 ) ,GT  (1 3,13) «HT (13, 
1  F  r ( 13,13) ,3H (13,13) , GM (12,13) ,  *0 ( 13) , H 

1P0(13,12) , QT ( 13, 1 3) ,RT (13,13) ,CCM1( 26,26) 
1> ,WXU(l3,l3l,»<FSS (13,13) , wvl (13) ,wv2(l3> 
1WH1  (13,13)  ,WM  2  (13,13)  ,h.l3  ( 13. 13)  ,WM-(  13,1 
1hmA( 26,26) »WM8(26,2t) ,WMC ( 26 , £6 ) , hn C(2o , 2 
‘l  .UU  (13,13) ,HXX  (13,13) ,FA(e*,2c» ,6A(2c, 
1  GC* (13, 13) , GCZ  (17,13) «  Q  A  (26 ,26) »PX  A (26 
1  KU3UT(13)  ,MXT0UTU3)  ,PXT0UT(13)  ,  PUOUT  { 

1  GUA(26,26)  , MX  AHI N ( 13 )  ,HXARAX(13)  ,HUMIK 

1  PXTHIN(13),PXTHAX  (13)  ,PUMIN(13)  .PLMAXCi 
1  RA<26,26) ,eCY (13,13) ,BCZ (12,13), GCY (13,1 
1WK7 ( 13, 13) ,WM 3(13,13) ,hmB(i2,13) ,«M1o(13, 
INTEGER  IFlGCZ,IF.Y 
REAL  MU(13) 

CSMI1CN  /RNTIH/  RNTIME.OELTIF  _  .  _ 

CO  Mr On  /mAIn2/CCm2 

_ CO M H CM  /MAIN1/K0I  M,_N0:M1,C0“1 

COMMON  /  INOU/  KIN,  tout, K»UNCH 
COMMON  /HA  I  Ni»  /NOI  M2  ,  NO  I  M3 
COMMON  /MAUN?  /  MSG 

COMMON  /maino/  IC5T.IC3'’,  ICPA,ICGt,2C5M,I 
1  IRHT,IROA, 10, LOG, IRH m, NU MOTS 


13) ,AH (13, 13)  , 

.M(  13,13)  ,QM(l3 ,13)  , 
,C0H2(2b,2&) ,GCSTR (13, 13 

3)  ,"liV5"(T3,  13)  ,  hM6  ( 13,12)  , 
6)  ,mh£(26,26),*HF(26,26>, 
26 ) ,GA ( 26, 26) , MXA (26  > , 

,2  6) ,PXV  A ( 26 ,26) , 

13 ) ,Y0 ( 1C?C) , 

(13) ,MU«AT (13)  , 

3) , GCZA (26,26)  , 

3)  ,FC  1 13,13)  , 

13) ,WV3(26) ,WV-(26) 


::gt,:coa,:£fa,;rfm,ifft, 


KIN« 1C 

K0UT»6_  _ 

>  PUUCH_s  7 
NDIM*13 
NOI Ml*  NOI H*1 

NOI r2«  26  _ 

N0IH3«15C  ! 


12. 

£  u  1 1 3  j 
COOIC 
0CC15C 

co; 16: 

003173 

eiois- 

00019: 

CL  0  20  5 
C  03  213 
C  32  221- 
0CC23C 

0  0 m 24  j 

"g;o25: 
oo'.2e: 
0:0270 
OCC  26: 

o::29: 

00030: 

C  DC  3X1 
0CC32I 
c:*.33: 
OCC  34" 

ooc 15: 

000Y6: 

ooc3?: 

occie: 

030291 

003-53 

.000-10 

0C-H2: 

02C-3C 

0C6-43 

000-53 

occ-Lfc: 

occ-7: 

003-63 

aic-9. 

00Q50C 

503513 

000620 

0C:E30 

500540 

co:55: 

C00:60 

5:057: 

c:;583 

000592 

c 


000613 
CC262: 
c:«63. 
OOC  640 
00555* 
03066? 

ooocT? 

0CC683 
0CC69C 
3C:7&J 
001713 
OC 3723 
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►••••••>»:»!  pscgsam  fcllgas  ••♦*•«* 

.?a,  ICxT  INO.CiTE  0*S. COLUMNS  OF  c4T-.;<  XT 


■  11 
12 


•THIS  PSCGSAN  can  Hi.\OL£' up  TC  10  J  ) 
rUMTlME.OELTI-.ANO  UMSP5CIFISO 
00  2532  L9G*l,13uC 
HSITEUCUT,  11)  «  * 

FORMAT <At,/) 

F3SM4T(4i) 


OI*eERsNT  CC 
PARAMETERS 


M5IN4TI0S  CF 


IS  SUN  NUFSES  '.LOG 


HFITE4K0UT  ,*) 'THIS 
NSIT£<<OUT **)  »  * 

WPITE4X0UT,*)  »  •  " 

WRITE4K3UT,*)  'ENTER  A  OESCRIPTICN  CF  THIS  5'JN>* 

WSIT£4'<0UT »•)  *  • 

_ R£AO  4<lN»l2)OSCRPT _ _ 

»«3IT£(<0UT *•)  •  •  ------ 

HSITE4K0UT ♦•) *  » 

CAUL  iNPUTMtFT.aT.GT.HT.FM.SF.GM.HM  ,P0  ,QT  ,0  M.ST  ,S>*,  :<0  , 

1  MUU.HXX.V4XU) 

IF  <10. £0.3)  THEN 
GO  TC  233.3 

ENO  IF  -  -  -  — 

CAUL  SOS  4GCSTR.SKFSS.SCX .GCT.GCZ.dCT ,3CZ,FC  ,T0, 
lWMl,«.N2,.4"3,MM<,t«i)>5,MM$f  WM7.*F*,NH<9  .aMIJ.HV  I  ,  WV  2  . 
lHMA,UH3,HHC.HH0,H“E,W-F,FT,aT,GT,HT,0T,ST, 

1  FM.EH.GM.HN.GN.RF.XO.PC.mXV  .hUU.uxu.F4 . 9 A  . S A  .aa.GUA, 

JL  MXA  .PXA , SA.PXY A  «GCZA .IRY . IFlGCZ* IFLGS3 . 

1HU  , PUN AX .  PUNI  N.PXTMAX.PxT  **I  h  .  HUM  AX  .  HU  Hi  N  ,  MX  A.H  A  X  ,  HX  A  HI  N, 

1  PUCUT,PxT0UT,.1XT0UT..-UCUT,mZ,WVt») 

WRITE  4 KOUT . •)  »  * 

WPITE4«UUT,«) '00  V3U  WISH  TC  CALCULATE  THE  EIGENVALUES  OF  Th£  CLOSQC 1360 
1EO-.COP  STATS  TRANSITION  MATRIX  USED  IN  TM£  PERFORMANCE  ANALYSIS  331370 
1  (APPLIC A3  IS  TO  30TH  Th£  CCNTINUCUS-TIME  AND  SAwPLSO-OATA  CASEJ 
OS 


J  •  «  /  ■*  4 

3  3  3.'5  j 

c : ;  r  6 : 

•••fas 

»  •  •  •  J  m 

3j::3j 
GCO  3  3u 
033313 
03C  *25 
333333 
033343 
0C3J50' 
033 363 
:::373 
313333 
3C3390 
3CC903 

scan: 

330920 
3CC933 
C 33  943 
00C953 
333963 
•33  3  97  3 
3C3  93  3 
333993 
331)33 
331313 
131)23 
QC1 333 
031343 
GG1050 


1  T  OS  N>' 

S£»0<KIN,12)HSG 
IF  (HSG.EO  .'•>')  f  HEN 
MSITe(<OUT«*> 'THE  CLOSEO-LCCP 
1  ASS...' 

NS  A  VHP  I H _ _ 

NdtH*N0IM2 

NQlMl«N0IM2n 

CALL  N£IGN  (MMA.WV  3  ,«**-.  IRFA  ,h.»£) 

NOtil»NSAV 

NOlm»NSAV*t 

ENO  IF _ _ _ 

WRITE 4 KOUT » •)  •  "• 


STATE  TRANSITION  MATRIX  EIGENVALUES 


TO 


FSRFCRP  THE  COVARIANCE  ANALYSIS.  TYPE 


HPITECK3UT,*) 'TYPE 
1  H  TO  SKIP  IT*' 

»EAO  (<IN,12)1SG 
IF  <CS3.S0.'N*)ThEN 
GO  TO  2932 
ENO  I? 

_ CALL  ®£SFAL  <  I3Y,IFLGCZ,HXA,GCY,GUA,PXA,PXVA,:flGS0, 

1  SA.GCZA,Y0.HhA,.vm3,mmE.««MF,».m0.WM1.MU0UT  , MX  TOUT,  FUCUT.PX  TOUT, 
1  •XAMIN, MX4MAX»PXTHiN,PXTM4X .MUHIN , MUM AX  *PUM IN . PUMA X  «MU, MMC* 

1  m/3,MY») 

2932_  CONTINUE 

2933  HPITSIKOUT,"*) 'PSOGSAM  TSSwlMTEO,  NO  HOSE  INPUT  C AT4  ' 

EM  3 

•  OcC <  STORE 3 

SU9SCUTI.NS  STOSEO<lHC“PN,PNT:>«E,OELriM,IFSTCL,:Sl2SZ, 

i  :SlJSZ.:Ol-SZ,rSt5SZ,STOFi2,ST<?e.  j,3T0Pl..ST0S:?,N0r,'9) 

C  STO  .£  3ATA  TO  3S-. '1 4NEMT  *!.£ 


0  C 1 )  9  -3 
'301)90 
0C113J 
331113 
331123 
301133 
301140 
001153' 
331163 
001173 
331133 
031193 
031203 
03X213 
001223 
331233 
30 1240 
0C125J 
031260 
331273 
301243 
031290 
QG1333 
331313 
001320 
301131 
9C 1 14 j 
331153 
C31360 
c:i T73 
CItlSO 
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Copy  available  to  DTIC  dow  not 
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o  o  o  o  o  O  I  ,  I  •  i  '  O  I  I  I  o  j  0,000000 


THIS  SU3RCUTINE  STjRtS  PLO’  ?ATa  TC  LOCA.  eIL£S«  TiOii’ ,  Ti?£l3. 

tapei-  Ti3-:i5  fc?  permanent  storage.  isxysz  is  t«e  size  :e  t-e 
gata  arrays. story*.  f.::-  :s  t-e  calling  f-zz-d*  dimension  oc 

r-£  A  ■;  'AYS.  *:c  r  £  r«4T  tUN  T£  *Z  *0  TI  **  ♦  ’  G  :  V  ES  T4£  TOTA:. 

nunter  of  oita  oo:\rs  in  t^e  run.  the  last  entry  i*j  £jch 
__  OATA  FIt.£  IS  T*-£  SCALE  FACTO*  FGR  TME  OATA  Z'i  TH£  FlLi.  T*S 
«£<  T  TC'  LAST  ENTRY  IS  THE  '■IMr.NUH  /ALU£  OF  TH£  OATA  I K  TH£  FIL 
01 MENSION  ST0*12CN0I»*6)  ,S  TQR13  <  NQINo)  ,  ST0=1  <*  t  NQI  N6>  ,STO«  1 «  <NOI  M6  > 
CCNNCN  /IN3U/  <aN,KOUT,<PUNCH 
IF  (IFSTCL.EG.J)  T*£N 
PUT  A  3 UN  MEAOc.R  CM  TM£  TAPE 
OPEN <U.*IIT«12,£RR»13. FILE*  *TAPEl2',S£CL*«3) 
OPSMCUNlT»tJ,£Sa»r:,F:L£i  •TAPEiJ»VftiCL*'asf 
OPEN  (UNIT*!*, £RR*13. FILS*  *T AP£1 .  »  ,S £CL*<3  31 
OPEN (UMI T* 15. ERR* 1 j. FILE* *T AP • IS » .PECL*60 > 

_  WRITS<12,101)  :-<CmPn,P.NTI‘iE,05lT:n,;S12SZ 

MRITEI  13,131)  INCHSN,rNT:-i£,0£LTI.'»,:Sl3SZ 

__  Mi*  I T£ (  1<4,  It)  1)  IWCHRN.PNTIME  .CELTI'SISI.SZ 

WP.IT£Cla,Ul>  I*OPN,F.NTI*£t0£LT:«,;Si5SZ 

11  FORMAT ( *  ‘,I13,1X,2£19.6»I13> 

£N3  IF 

IF  HFSTCL.tT. 0 )  TM£n 

ctose  files  anc  put  end  of  file  marker  :m  them. 

CL3Sc(12.ERR*13> _ 

C<.OSS<13«5RR*10>* 

CL3S£ci^,;sp*ia) 

CLOSE (15 .ERR* 19) 

RETURN 
ENO  OF 

MRIT£(  12.132)  (STC312CT  ,I»1.1S12SZ> _  _  ___ 

NRifsCU,  132)  (STOSlcC)  .  I»l".ISllSZ) 

MRIT£(  14,132)  (ST0R14II)  ,I«1,IS14SZ) 

MRITsIlS.iaZ) (STOFiStI) ,I*l,:Si5SZ> 

RETURN 

1  W®1T£(<<0UT,*)  *AN  ERROR  ms  CCCURREO  IN  Tnc  STGREQ  ROUTINE* 

12  FORMAT  (3  (•  (__•  »  ,  £19.6  .  I  >_./)  ) _ 

£M3 

OECK  INPUT* _  _  _  _  __ 

SU9RCUTINE  INPUTM  (FT.aT  ,5T  ,M  ,F>, 5N  ,GN,  HN  ,P0  ,CT  ,0- .RT.Rn.XO  , 
1MUU.HXX. NXU ) 

CHARACTER  MSG*60  , MSG 1*5 3 

_  REAL  FT(NOIM.NOIM)  ,9TCN0I.M,A0IF)  .GT(NOIH.NOIH)  ,HT  CNQIN.hQIM)  , _ 

”lMH  (NOIM.NOIN)  , 

_ 1QH(N.0IM.NCIM)  .RMNOIM.NOIP)  .XC(NOIM)  , 

1  ML'UtNOi.N.NOIH)  ,MXA  (NOIN,  POINT  ,  FH  C  NOIN,  NO  IF)  ,  3.M  (NO  IM,  NO  IN)  , 

1  GM(NOIM.NOIM) .NXU(NOIN.NOIF) . 

1  P3(N0Ir,*0lMI  .OT(NOlM.nOlN)  ,«TCNOIJ1,NOI.'1),CO«1U)  .COM2  (1) 

_  COMNCN  /M  A iNo/NO I N2  .N0IM3  _  _ 

COMMON  /NAIN2/C0M2 

CCNNCN  /NAlNl/NOlH.MJlNl.CCPl  _  _ 

COMMON  /  INOU/  <IP,<3UT,KBUNCH 
CCMMCN  /MAUNS /  MSG 

COMNCN  /NAIM6/  IC3T  .1 C3 *♦ ICF A  .ICGA,.CGM,£ CGT, I  SO A, I 9FA, 2RFN.IRFT, 

1  I RH T. IP QA.IO.LOG. IRHM.NUfOTS 

mSS i «. » 

ICFT«;*pT,:CFMa:FFM,:R3T*:FrT,IRBF»:PFN, IRGT»ISFT,IRGM*I=FM 
ISX*iaF,IRq«ICO*ICGN,IRfi«ICR»IPNT,IRNXX*ICNXX»IRFHf 
IRNUU»ICMUU»IC  3M»ICHT»IPFT  ,  ICh:i»  IRFm.  I°GCZ*IC3T,  icgc  Z»  IRmT  , 

10  IS  A  INPUT  ROUTINE  PARAMETER—  i*REA0,2»A.£A01PRINT, 

3*  PRINT  ONLY,  •■PUNCH 

nSAV*nO!“1 

NOlMl*NOI» 

IF  (LTG.tl.l)  TMjN 
NR  ITE  ( <OUT  ,  •)  ■'SGI 

WSITE(<<3UT,»)  *TaE  I/O  CATIONS  Aij  3  , 1 ,2 . 3  ,»  .  5  ,  . * 


•:  :i59: 
o  i  i  « a  3 
c :i-i: 
2.1-2- 
::t-3c 
3  C  1-*4C 
3  Cl. 51 
311.62 
oner; 

001480 
001493 
CC1503 
3  £  1 5 1 3 
001523 
031533 
331543 
00155C 
001=60 
OC 1523 

C  t»  1 3  8  w 

3wl59C 
031533 
031610 
33162: 
201630 
3  3164  3 
021653 
031663 
031673 
3  31680 

aci69u 

021703 
3C1713 
aoiT25 
001733 
001743 
301’53 
3Cl763 
031770 
031783 
00179a 
331330 
031313 
021323 
.  a  1  3  3 . 
30134? 
0  C 1 3  5  3 
301363 
001 370 
031 38 J 
0C1393 
2  0193_0 
201910 
30192? 
0C1930 
221942 
301953 
C:i962 
C  0 1973 
3 :i93? 
021990 
2:2030 
302310 
0:2020 
0.2330 
0:2:43 


1  .■&% 


33331 


w;iT-<OUT.»>  •_  .1CR£_  :  R'JT.* 

"*9:T£(<')UT,*>*iS"G1 

*RIT£(KOUT,*|  'SELECT  AHICH  MATRIX  Y3U  (ISM  TC  ENTER.* 
*RIT£(«OUT,«)  *3f  £MT£» I nG  Th£  APPROPRIATE  NUMBER.  1-FT, 
W»ITE(KOUT.»)  *3-GT,..-MT,5-FM,e-3N,7-G.N,a-MM,9-P0,t:-0T, 
W®ITs(«UT,*)  *12-CM.13-®M,1  — X0.15-.UU.i6-*XX,17-»<U.13 

_  •  __ 

~5TiT?T<Gyr,»i  •cont®':u^''!''gc£l  ;taTicES  ro  their  “♦ 

MRITSUOUT,*) 'TRUTH  MOO  £  L  CCUNTSRPA  RTS.  19  —  —  -  NO  MORE 

MRlTEtKCU t »•)  'ENTRIES  TO  3E  MAOS.  2u~  STORE  ALL  mATRICE 

HSITEtKOUT,*)  *21-  Sf.lO  ALL  MATRICES  FROM  T APE i  * 

W®IT£C<0UT,*»^SG1 

*RIT£(<0UT,*) .mSSI 

mFIT£(<0UT ,*) *  * 

WRITetKOUT,*) *®0R  SAMPLSO  0AT4  •SASUfiEMENTS, ENTER  £ITM£ 
LOUS  TO  USE  TO  AP®9C»IMAT£  THE  OISCRETE  TIME  SmO(RmC) 
1TIM£»  0®.  £NT£R  TH£  (DISCRETE  TlM£j>MO*_ 

*RITE(OUT,«)  <*SGl 
HR  I TE ( KOUT  •  *)  MSG1 
£N0  IF  ~ 

00  9!2  lNPUT*l,tjU  _ 

m«IT£(<OUT,  133331  •  * 

FORMAT  ( A15  «/) 

WRITE (KOUT  »•)  *  ENTER  C00£  FOR  'i.HXCH  A.RtA  Y/vECTCR  TO  3E  X 

REAP  (KIN,*  >  !WCHMA_ _ _ _ _ _ 

GO  TOIL  *  2  « 3  13  , 1 5 « 19*2 


■*T  * 

o  ■’aint* 
nt ; 9  *  * 

7S  TH£>,< 
•JC  • 


2-3T* 

ll-RT,** 


.Jt .5. 

:tz: &; 
: 12 .r: 
::z: a; 
2:2:9: 
C32102, 
:c2iij 
092120 
352133 
032143 


RMOHRmO 


-ECU AT  £  ALL  G  32153 
332163 
00217? 
DATA*  532 185 

S  CN  TAP £7 *002 190 
C522J. 
032213 

_ 352223_ 

032233 
A  A  CCNTIMU03224: 
«RM/SA**PLS  002253 
0  u  2  26  5 


!  C***T 


RUTH  W)9£L  INPUT 

WPITS(KOUT,*l *£NT£R-I/0  OPTION,  FT  MATRIX  SIZE** 

SE4Q  (KIM, • , £N0»27> II, IRFT 

MSS* 'TRUTH  MOOfL  F  MATRIX  ENTRIES* 

CALL  MHAfTO  (FT • IRFT , IRFT^X C ,< IN ,KO UT.NOXM, NO INI  I 

IF  (10. £9.0)  JWEN _ 

“RETURN  " 

ENO  IF  _  _ 

GO  TC  952 

4RIT£(K3UT,*I *£NT£R-I/0  OPTIONS ,  COLUMN  SIZE  OF  gT* * 
“  RlAO"  (Kt  N  ,  •  ,  E.N  0*  2  7  TI3TIC  3  T 
,MSG**TmUTH  MOOEL  3  MATRIX  ENTRIES* 

CALL  HMATIO  ( aT  »IRFT, IC3T  » IC«  KlN.KG  UT.NOIH,  NOlMl ) 

IF  (10. EG. 31  THEM 
RETURN 
£nO  IF 
50“ TO' 312 

WRIT£(KOUT,*) «£NT£R-I/0  OPTION,  COLUMN  SIZE  OF  GT»* 

R6A0 (<:h,*.£n0«  27 ) IC ,ICGT 

.MSG* 'TRUTH  MOOS'-  G  MATRIX  ENT-ISS* 

CALL  HMATIO  ( GT , IRF T.ICST , IC ,K IN ,«0UT ,N0IM,  NO IH1 ) 

IF  (10.  £0.0 1  TH£N 

STTurh . . 

ENO  IF 
'  GO  TC  382  * 

WP.ITStKOUT,*)  'ENTER-  I/O  CPTJCN,  90*  SIZ£  OF  HT> » 
RSAOIKlN, *, £*0*27)15, ISHT  ' 

MSG**M  matrix  Entries*  __ 

CALL*  MMAT 10  (MT, IRHT.IRFT , I C  ,<IN , KOUT, NOIM, NOIN1 > 

IF  (10. £0.2)  THEN 
RETURN 
ENO  IF 
GO  TC  i*2 

NPUT  C34Ta;t.£J  *CC£L 


022273 
_  302293 

302290 
352335 
032313 
352323 

NPUT>*  3C233C 

032343 
3,2lTlWCMMA0C2J53 
302363 


Of  2 375 
002393 
032393 
0C24Q5 
SC  2410 
0025*29 
052433 
932440 
332453 
93 2  *6  3 
TC2479" 
002490 
552490 
0C2599 
CC2315 
0:2525 
352533 

052=4) 

5 C 2550 
0C2563 
052573 
302590 
502590 
032633 
352610 
332625 
C  5263* 
532640 
332553 
032660 
032673 
QC2690 
OC  2639 

0:2?): 


Copy  available  to  DTIC  does  nM 
permit  fully  legible  reproduction 


ws:r£(<:'jr,»>  •;  jr£5-:/c  ;=t ;c*. .  e-  -atr:*  si^s** 

-  •  A3  <<:•!,  ',£‘0*37  j ::.  i—n 

M$3a  «C0-)TSCLL£S  “CQ£L  B  ''iTAIX  £ST5I£3* 

-•  If£(<JUT  ,*)  ‘£'ir£s  T-s  su.“:t:  .F  Qi T£R .1  3TI 3  ;T1TI3  I'i  T«:  1 

l£.>  * 

R£AO  (<I  (.*  .£'0*27)  SLOTS 

CALL,  Mi  AT  £0  (  F.N.  IRF  M  ,  ir -«  ,IC  ,k;  N,  KOUT  ,NOI  M,  N3I  Ml  > 

IF  (13. £1.3)  T  H£  M 
SETUPS 
£N3  IF 
63  TC  332 

W-ii.  T£  (  KOUT.*  I  'SNTE.R-1/  C  OPTION.  COL?MN  SIZE_0F_3M>» _ _ 

PE40«I*I.».£N0»27)  I0.IC1M 

NS 6*  'CONTGRLLER  MODEL  0  MATRIX  ENTRIES' 

CALL  MNATIQ  (  AN,  I*«*t,  IC9H  .  IC  ,<IN,«0  UT.NOIM,  ND  INI > 

IF  (10.53.3)  TM*N 
RETURN 

END  IF  _ 

"  GO  TC  942  " 

M»ITE(<3UT,«> 'ENTSR-I/0  OPTICS.  COLUMN  SIZE  0B  Gm>* 

PS AO (<IN.*,£N0»27 II3.IC5M 

MS5»  'CONTROL!.  £R  NOOSL  G  MATRIX  ENTRIES* 

CALL  NNATIO  ( GM, 1RFM, ICOM  ,  I C ,K IN.KO LT, NOIM.  NO  INI > 

IF  (I0.5Q.3I  THEN  _ 

RE  TURN 
EN9  IF 
GO  TC  942 

MRIT£(<OUT,*l 'ENTER  I/O  OPTICS, ROW  SIZE  OF  NN>' 

BEAO (KIN , • , EN0*27 ) IC. IRNM 

MS«*^THE  CONTRO*.k£R  HOOtL  MEASUREMENT  NAT:iX.  MM,  IS* 

C-LL  NMAT  10  (H.N,  IRMN.  IRF“»  10  ,K  IN.K3UT .SOlM.NCI Ml)  " 

IF  (IO.eO.ai  THEN 

RETURN 

ENOIF 

GO  TO  132 

HSITSIKCUT.*)  *FT  MUST  3c  ENTERED  Thru  OPTION  i  »RICR_TO  USING 
t  OPTION.OO  YOU  WISH  TC  A33RT  THIS  OPTION^  T  C9  s>' 

RS43«lS,97,£Na«27)MSS _  _  _  _ _ 

IF  (MSG. £3.  'V'  I  THEN 

_  GO  TO  912  _ 

~ENO  IF 

WPITEIKOUT,*) 'ENTER  I/O  CPT ICN, IRFT_IS  ASSUMtO  SIZE  OF  AO*  * 

RE AO (KIN, • ,£N0«27) I C 

MSG»*THE  INITIAL  COVARIANCE  MATRIX, PO,  IS' 

CALL  NNATIO  (PO.IRFT.IPFT.IC.KIN.XOUT.IOIN.SOIMI) 

IF  (10. £0.31  THEN 
RETURN 

_ END  IF _ 

GO  TC  942 

4PIT£(<0UT,»)  'EnTER  I/O  OPTION,  ICGT  IS  ASSUMED  SIZE  OF  1T>< 
READ (KIN, •,£N0«27) IC 

_  MSG* 'THE  input  NOISE  STRENGTH  matrix  it  IS' 
call  N.1ATI3  (OT.ICGT.ICGT.ICtKtN.KOUT.NOIf'.NOIf'i) 

_ if  do. £3.:>  then _ _  _ _ 

RE  f  (JAM 
ENO  IF 
GO  TC  942 

W<».IT£(KOUT,*> 'ESTER  I/O  CPTIOS.IRhT  IS  ASSUMEO  SIZE  OF  =T>' 
R£A0«IN,*,£N0«27)  IC 

_MS3*'TN£  MEASUREMENT  NOISE  STRENGTH  MATRIX  RT  IS' 

CALL  JMATIO  (RT.IRHT.IRHT,  II.KIN.XCUT.-IOIM,  N0IM1) 

IF  (IO.EQ.vi)  THEN 
RETURN 
ENO  IF 
CC  T3  932 

msITE(<3UT,»)  '£|T£R  I/C  GRTICs.IOG*  IS  ASSUMED  SIZE  OF  G**' 


::zr:: 
j:2’2: 
0:2-3: 
-rroc  :2^a: 

0  .  2  75 2 
: :z'i : 
332773 
3.2753 
202*90 
C  324  3  3 
032513 
322322 
3  C  2333' 
002340 
3.2*53 
1C2450 
332370 
332433 
322493 
332900 
322910 
3C2920 
332933 
0 1 294 J 
032953 
322953 
C  02  970 
0C2943 
332993 
S0330C 
003010 
3.3323 
003030 
633  343 
003250 
THISQ0326-: 
323370 
00334C 
023390 
033133 
333110 
033120 
033133 
33314J 
003150 
003153 
003173 
333130 
303190 
303200 
303214 
003223 
3  v!  3  2  3  3 

_  003240 

::3253 
0C326J 
023273 
023203 
QC  3293 
503703 
323313 
003320 
303333 
CC3740 
C  0  3  T5  : 

I 762 


V  V-  -  ‘.S,  ..  .J  -J  ^  •.  '.Vji'j  -■  ~-M 


193 


W'flPJ  J>! Vi Pjj IP. T  J  .»ij  'JPJI! J  JtPJi'JPjm ■> ’3. ■■'. «.l ■» M- A .1'^ 


1 


VJS 


13 


14 


.  1 37; 

mSG*‘C  JuTRCLLc.R  iCOc.  I  .PUT  ^ISE  STRENGTH  «STSTx,  ««•  id’s: 

ci.-  'HiT:c(3'*,;c54,;;l;4t;o.|«:N.<ouT,N04»iro:«n  ;:m: 

IF  C3.20.31  T«£n 

return  ojj-i: 

so  if  _  ::j-2: 

GC  TC  iiZ~  "  3IJ-3C 

WRIT£(OUT,»1  *£MT5R  1/3  OPTICN,  IRH.m  IS  ASSUMED  SIZE  OF  »n»  •  0i34<»3 

Pc  10  (<IN»*«SN0*27I  10  0:J»5C 

MSG*  'CONTROLLER  MCOEL  MEASUREMENT  NOISE  STRcNGMT  MATRIX,  SM«  3:3*40 

call  mmatioirm, irh.m, irhm.ic, kin, <cut,noim,noinu  00347: 

IF  ( 10  .  SO,  3 1  then _  _ _ 0:3480 

RETURN  JC3*90 

ENO  IF  333503 

GO  TO  932  303313 

PRIO*  TO  'JSING  TWIS0J3523 


OR  N>  • 


!  15 


3C3333 
303343 
333353 
333563 
033373 
333533 
503533 
333503 
'  503513 " 
303523 
3C3533 
3  C  3643 
003650 


m 


NAITEIKOUT  »»l  'FT  MUST  3£  ENTgeEO  Thru  OPTION  : 

1  OPTION.  00  V0U  WISH  TO  A6C5T  THIS  OPTION,  i 
_REA0KIN,97,SN0*271MSG 
IF” (MSG.cQ. *Y  *  1  THEN 
GO  TC  342 
EnO  IF" 

w»  IT£  (KOUT,  »1  *  ENTER  I/0_  OPTION, I*rT  IS  ASSUMED  SIZSCF  XO>* 
R£A0(KIN*»£N0*271I0 

MSG*  *TH£  INITIAL  STATE  SECTOR,  XO,  IS* _ 

"CALL  MVEC'iOfXO,  I'RFT.iO, KIN, KCUT,N0IM> 

IF  (IO.EQ.3I  THEN  _ 

RETURN 

END  IF  _  _  _ _ 

GO  TO  332 

hPITECKOUT.*) »3H  MUST  *E  ENTEREO  Thru  option  6  OR  1t  PRIQP  TO  USIN33 3663 
1G  THIS  OPTION.  00  TOU  WISH  TC  A3CRT  THIS  OPTION,  7  OR  N>«  JC3&73 

R£A0(KIN.37.cNQ»27>MSG _ _  _  303683 

IF  (MSG  .EO*  'Y'l  THEN  3^3693 

GO  TCJ32 _ 003700 

ENO  IF  ”  033710 

WR.TEIKOUT ,*1 'ENTER  I/O  OPTION, IC3H  IS  ASSUMED  SIZE  OF  WUU>» _ 0C3723 

REAd(Kifi.*i£N0«27ltC  ”  ~~  '  933733* 

mSG*  *THE  CO.'lTROw  FUNCTION  COST  WEIGHTING  MATRIX.  WUU*  _  _  303 740 

CALL  MNATIO{WUU.tC3M«IC3M.IC,KIN»KOUT»NOIN»NOlMll  333753 

_  IF  CIO. £0.01  THEN _  _  003763 

RETURN  ““  333773 

ENO  IF _ 003783 

GO  TC982  ~  333793 


16 


WRITE (KOUT ,•! *FM  MUST  9£  ENTEREO  THRU  OPTION  5  OR  17  PRIOR  TO  USIN333803 


1G  THIS  GPTIOn.  OC  rau  WISH  to  A3CRT  THIS  OPTION,  Y 
p S 10  (KIN,97,E»I0*27J  hsg 
IF  (mSG.EQ. '('I  THEN 

GO  TC  942 _  _  _ _ 

"  ENO  IF* 


«-R  "I** 


18 


hRITE(<OUT,*1  *ENTS.R  I/O  OPTICN.IRFM  IS  ASSUMEO  SIZE  OF  „XX>* 

RSAO  (KIN.*,EN0*27JIC 

MSG»»THc  STATE  COST  WEIGHTING  MATSU,  WXX • 

CALL  MMATIO(i»XX,IRFM,IRFM,IC,KIN,KOUT,NOIM,NOIM1) 

IF  (lO.EQ.Oi  THEM  _  _ 

”  RETURN 
ENO  IF 
GO  TO  992 

WP ITEIKCUT ,•  1  *  ALL  CONTROLLER  MCOEL  MATRICES  HA«£  eSENSET  ECUAL  TO0C3940 
l  THSI.R  TRUTH  "OOcL  COUNTERPARTS'  0C3950 

Hr  I  TE(  <OUT_»*1  *f  T,3T.GT,hT.OT,sT  must  9S  ENTERED  PRIOR  TO  USING  TWI0C396Q 
IS 'OPTION,  THE  .UH3SR  3F  OETESmInISTIS  STATES  MUST  9E  £NT£5S0  In  0C3970 


0C3310 
033523 
333930 
003343 
003350 
033360 
033970 
033380 
CO  3390 
CC3905 
003913 
033923 
0:3  533 


i  this  option(fop  comtsoller  ncosli.' 

W-IT5(K0UT,*I •  00  yhj  l:sh  TC  A’CST  this  OPTION. T 
*S  10  (KIN,  97  ,£*<0*271  '■'SO 
IF  (wSG.EO.'f  *1  T-Su 
GO  TC  9:2 


;»  n>  1 


033983 
3C399C 
0  C  4 ;  o  j 
3  C  4  3  i: 
00-32: 


194 


£*o  ::  2;-  z: 

*£:4T;=  the  •■.u::i£s  :f  cetsr.tm  gt:c  states  tu£ 

«  i  r>  T3  -4«  rr  y  i  <  -  *  a  -. 

’•ioic.'i,*  ,£-o*r»'.cors  j:-:<b2 

I5r-*irft  2:4273 

iciM*i23T  ::-29: 

:cgh»icgt  :o4io2 

IPHM*IRHT  30i.li; 

CALL  SQUATCCFM.F  f  ,I,FT,IRFT)  32-122 

call  squate(9*i,3T,irft,:c3T)  30413: 

CALL  EQUATE  <G.1,GT,IRFT,ICGT>  _  CC4  143 

'CALL  £QUAT£(HM,hT,IRHT,ISFT)  224152 

CALL  SQUATS ('l't.QT,ICGT.;CGT>  0C4160 

CALL  EQUATE(P.M,RT,I-HT,iaMT)  304171 

GC  TC  332  524190 

WRIT5TF2UT,*)  ‘.‘JOTS  THAT  F  .1  Af.O  3-1  MUST  9S  ENTERED  THROUGH  AFPROPOI  224190 

1ATS  CPTIONS__PR_IOP__TO  £X_SCUTlsG  THIS  OPTION,  QO_  TCU  WISH  TO  A30»T  T024290 

1H IS  OPTION,  V  OP  M*  *  -  -  —  0(,42t; 

READ  (F:n,97,E.nO*2?)  mSG  ■  _  22-220 

IF  IHSG.£G.*YMTH£N  024233 

GO  TC  942  32424: 

ENO  IF  02425) 

WW1TE( <OUT »*)  *£HT£S  I/O  OPT.CN,  I*r,M  X  IC5M  ASSSUKtO  SIZE  WXU>*  324262 

PEAO(FIS,*,£NO*27)IC  "  '  ‘  354273 

MSG*  ‘THE  CROSS  (STATE -CONTROL)  COST  "SIGHTING  PATPIX,  haU'  2:4233 

CALL  M.MATIO(WXU,ISFP,:C3H.IC.I<IN,«OUT,NOI.'*,NOIN1)  054293 

IF  ( 10 . SO,  OJ Th£n _ _ _  _  _  204303 

RETURN  ‘  .  024313 

£NO  IF  C:422; 

GO  TO  342  ~  -  054333 

WPITSUOUT,*)  *  THIS  OPTION  STORES  AlL  MATRICES  CN  TO  TAPE7,  00  YOU3-4J43 


1  WISH  TO  4  309  T  THIS  OPTION,*  CP  N> *  004350 

_Rf AO (FIN, 97) MSG  _  3  )4363 

IF  (MSG . SO . *Y • )  TH£m  3  34  37  3 

_ GC  TO  342_ _  _  _  _30L3S: 

ENO  IF  *  52*395 

HPITE(7,*IISFT,:CdT,:CGT,ISMT,IpF)>,iC3.M,;CGr,IPHM,NUM0TS  224-03 

HRITSI7,*)  ((FT(I.J),J*1,I»FT) ,I*1,IRFT>,(  13 T ( I ,  J ) , J«1 ,IC9T)  ,1 *1, IF  2 24-13 
IFT1  ,  (IGT(I.J)  ,J*1,ICGT)  ,I*l,I=FT> ,((HT(I,JI  ,J*1,IPFT)  ,I«1,IRHT)  ,  33  —  22 

1  (  ( FP  (I  ,  J)  ,J*l,IRFP)  ,;«!,!  IFF)  ,  (  (3!M(i  ,  J)  ,J*l,ICeM>  ,I»i  ,I-.F  P)  2  24433 

H9ITEI7,*) ( ( Gm( I , j) ,J*1,ICGh)  ,I«1,IRFN> , ( (HM C I , J ) ,J*1 .1 RF-I .1*1, Is '.4-45 
1HMI  , ((PO (I ,J) , J»1 ,XRFT) ,I*1,IFFT) , (XO ( I ) , 1*1 , IRF T ) , ( (WUU(I,J) ,  3  24-53 

1  J*1  ,IC3!i)  ,I*1,IC9H),((WXX(I,J),  J*  1 ,  IRF  M)  ,  I*  1 , 1 RF  p)  224-60 

HRIT£<7,*)  ( (QT(I  ,J»  ,J*i;iCGT)  ,1*1,1  CGT)  ,<  (PTC,J)  ,J*i,:*HT)  ,1*1 ,1»  224-73 
1HT)  ,  ((QM(I,J)  ,J*1,  ICG.MI  ,I*1,ICGM)  ,  (  (PM (I,  J)  , J*  1 » I-HM l  ,Is1,I;hh>  034-40 
WRIT£(7,*)  (  (UXUC  ,J>  ,.J*1,  XCEP)  *  1*1 » ISF.M)  0  54-90 

GC  T2  342  _  224502 

ARIT£<KOUT',»>  • 'THIS  OPTION  rSAOS  ALL  MATRICES  FROM  TAPES ,  00  Y0U3C4513 


1  WISH  TO  AaORT  THIS  OPTION,  Y  3P  N» * 
RE  AO  (FIN,  97)  MSG 
IF  (P$S.£Q.'Y*>  THEM 
GO  TO  352 
ENO  IF 


J04521 

0Q4530 

JC454C 

034552' 

024563 


WRIT£(<OUT ,•)  '00  YOU  WISH  TC  RHINO  TAPEJ  BEFORE  THE  READ,*  0s  x>»0C-572 


READ (FIN, 97) MSG  2.-542 

IF  (MSG.EO.'Y*)  THEN  3 '"4590 

RSHI.nO  (5)  00460  3 

ENO  IF  0C4610 

_ *£  40  (5  ,*  ,ENO*  133  33)  i-.F  T  ,IC  9T  ,ICGT ,  IRHT,  IPFM  ,  IC9-,  ICGm  ,1  NU^OTS  254623 

PE 40 (3 ,* , ENO* 13- 31) ((FT ( I «J)  ,J*1 ,IRFT), 1*1, I  AFT) , ( ( OT (I , j) , J« 1, IC80C4531 
IT)  ,£*1,  XRFT )  ,  (<GT(I,  J)  ,  J*1,ICGT)  ,I*i,IRFT)  ,  (  (HT  ( »  ,  J)  ,  J*  1,  I«.CT)  ,1*132-542 
l » I AHT)  ,  ((F.M(I,J)  ,  J*1,IRFH)  ,I*1,I-.FM|  ,  U3N(!  ,J)  ,  J*l, I C2M)  ,  I* l,  I*.Fm)  3 ; -65; 

P£40  (9**»£N'1*10J  33)  ((G.M(I.J)  ,J*1,ICGM)  ,  1*1,  IRF*)  ,  t  ( «M  C  ,  J  )  ,  J*  1,  I >F:  ;-66  j 
1M)  ,1*1,  IRhm)  ,  ( (PQ(I,J)  ,  J*l,  I'FT)  ,  1*1 ,  IRFT )  ,  (:<CC)  ,I*1,IRFT)  ,(  (WUU  (  054570 
1  I ,J> , J*i* IC3«)  ,1*1, ICS  )) ,  ( («XX (I , J) ,J*i, IRFr) ,1*1, IRFM)  jC-632 


J  l  3  »*.  •!  }•  1.  .  3  T  )  (  ( IT  c  ,  J  J  ,  J*l,  .  2  jT)  s  ;  ,  :  :*,T)  ,  (  f  -  7  C  ,  J  I  ,  1  3  'wi? 

ir»  .isi.i-i-ri ,«( (!  =  '-« i.j) ,  jsit .  „  .-r: 

i  i»i.:i'’M>  ;:-'i 

-£i3  h  » *)  ( i  .<jc  ,j» .j«i.i:3-» .1*1.1 t*h>  o:-72. 


10333  W  9 1 T*  t  <CJ  T  ,  * )  •  EN  3  3?.  'IlE  *  NCC’JNT  £*£3  QU-5ING  =  £A2  CF  TAPE;' 
982  CONTINUE 

19  continue 

no  ini*  msav 

9ETUSN 
27  IO«j 
C 

SnO  . 

•  OECK  NEIGH 

SUBROUTINE  MS IGNT A, APE  V , AI£/,CUpSZA,WM1) 

_ CH19ACTE9  hS5»50 

OI.1ENSIONA<NOIN,NOIN)  .APE;  <  NOI^I  .AIEVtNOI*)  *  4  HI  ( hOI  N,  NO  IN) 

_ ox i ensign  comud ,con2<i> 

COMMON  /NAlM/MQlM.NOlKltCCMi 

•  CO  MUCH _ /  INOU/  <lN,K3UTtKPUNCH 

CCMMCN  /mAIn2/  COM2 
COMMON  /HUH?/  *SG 

C  THE  CALLING  »OUTINS  MUST  SUP5Ly  A  «0«KING  MATSX  SOIn  x  NOI!*  - 

c»«»fino  the  eigenvalues  of  a  ,ns»u  tells  the  pcutin;  tc  calc*jl_at|_ 
“c  EIGENVALUES  only 

C  N31N  MUST  3E  Th£  91-mSnSION  OF  A  !n  Thc  CALLING  PPCSiAN 

np*; 

_ HP* ;  _ 

ci*i.o 

CALL  IOMT (C'JRSZA  .'4M1.C1)  _ 

C  wm£  «r  "  rifts E A  x  CU9SZA 

CALL  EC  GEN  (CUPS  ZA  ,A  .A  S£V  *  A  I£V  .WMi.NR) 

IC*5 

NS  A  V  *MQI N1 
N0IM1*N9IM 

mSG**.P£AL  P49TS  OF  THE  EIGENVALUES  * 

CALL  ilVECIO  4  AAsV  .CUPSZA  ♦  IC  .KIN  ,«CU  T .7)01  M) 

_ MSG»_*lMAG  P4HTS  0F_THE  eigenvalues  * 

CALL  NVSCIO  (  AIE'V  .CUPEZA.  10 .X  IN . KCU  T, N3 1 M  ) 


: cl  tic 
C  C-72. 
: cl” j: 

Z  J  ^  Tip  j 

::-75 : 
J14763 

:  34*70 
3:47a; 

304793 
OOt 300 

oi-ai: 

304*23 

3J43J3 

304  343 
014353 
304563 
3*4373 
3043  SO 
034993 
3  j»9G0 
314U3 

_ SC4920 

314933 
004340 
004950 
304363 
"00  <.973 
004380 
"334393 
005033 
005013 
305320 
3C5J33 
005340 
005353 
335050 
035373 

305  333 
035090 
•3C5130 

'  3  05112. 
335120 
oisiio 
335143 


NOI  Ml*  NSA  V  035390 

_  ENO  _ _  _  _  3  0513  3 

“•  OECX  COTCON  ”  '  - . -  3t>5lli 

_ _ SU3PCUTI.NS  COTCON(FN,3H,MXX,WUU,GCSTR,IHOLO  ,  ICS.M  ,WMi  ,WM2  ,  335123 

,wM6,MXU.F;».9IN,4AXP9M>  005133 

CMA9ACTE9  mSG*6-3  335143 

01  HENS! CNF  N  <N3lM .  NO  IN)  , WX X ( NO  IN, NO  I N)  » 3M ( NO  IN , NO If)  , NUU ( NO  I N. NO  I N )  3 35 15 3 

_  I.GCSTSTnOIM.NOIM)  _  0C5153 

0 1 N£ >NS ICN  4.li(NOlN,ftOlN)  ,MN2CNOI'*fNOI.N)  »Nh3  CnOIM.NOI.M)  ,«N-.(.‘.OI.N,nOOC5  173 
llM)  »4N$  (NOIK.NOIM)  .WMMnOIM.NOI.M)  .rfAUlNOlN,  NOlN)  .  0351S3 

1  hXXP.PmNOIM.NQIM)  ,FP=XN<N0IP,N0IM)  035193 

0 1  HE  NS  I  CM  COM11U  ,CCN2(D  £05231 

CONNCN  /MA IN2/COM2  "  005213 

CCHDCN  /NH-il/NOIC,NOIiNl,COFl  305220 

' CONNCN  /  INOU/  <*N,KOUT.«PUNCH  "  *  "  *'  '  005231 

CONNCN  /N1UN5/  NSG  305243 

C  005  253 

C*»*0ET£ANINISTIC  CCNTAOLLS^  GAIN  CALCULATION— MODULE  *  1  C05253 

C  305273 

c _ tm:s_n:ouls  computes  the  STssoy  state  oetefninistic  contpollep  ::e2si 

C  gain  NATS  Ix«GCSTAP«(4UUI)  (5fT)  XCSSPm)  •  HL-UI  IS  THE  I.WE-SE  2F  T305293 

C  CONTROL  COST  WEIGHTING  NAT-IV,  XCSSPN  is  the  STEAOY  STATE  3C5T32 

C  SOLUTION  TO  0«<C)/3Ta<FNTM<C)  *UCMFH)  lhXT-XC  »  (9N)  (*.UUI )  (9NT)»3C5313 

C  !<CI|  wxx  IS  TMt  COST  WEIGNTING  NmTsIx  CN  T4£  STATES  0C3T2-3 

c  ::5333 

c  KLliN.MAN  ROUTINES  l-Z  'XTE'SIViLY  USEO  IN  T“Ii  rCOULE  0  0 5 ?U 3 


xTv 


S7- 


\  v\  ■ 


*.v v  *.■  *> \-?'*.--,;-~*j.~l- r*  .-«  '.x  > ^  .v;."v.v 


i 


c 

C  T-»l‘;Sr;='l  SYSTEM  SJ  THAT  -XU  2  T  =  3  CAN  STILL  3*  “AnCLED  9Y 
C  <l£:-^V.  ROUTINES.  SEE  l <£ R NAA<  AvO  SI/iM'S  3CC<.  --rl  3Z2 

C-L  -  PCHTUn.^U  .Ii:a«.GCST  =  .*AU.  IMCLO.EM  ,h-2  .FF=  I*.-**  ,  «xxo=m. 
i  F 1 ) 

C  NCh  HA  Ji  F??I-,  -XXFR*  CAN  USE  RICCATI  SOLVE’  FCR  <CSS?m 


o :  =  is. 

2 . 3  16  I 
023  272 
: :  5  ?  a  3 

a 

305 -JO 
3  35-13 


V 

» 


i 

i\ 

3 

> 


A 


✓ 

> 


MT*l 

CALL  T  iANS2  (IhOlO,  103*.  3N.W»*2» 

C  WM2*3HT  IC3a  X  IHCLC 

CALL  ETJATS(W  n.HUU.ICa*,  ICS«> 

C _ GNlNV  J0ESTR3YS  THE  CALLING  ARRAY 

CALw  GJ1..N-V  UC3N.2l3H. AiU.NH3.hr, mT» 

C  *N3*NUUI  133 H  X  IC3N— — HR  IS  A*  ERROR  INDICATOR 
IF  (HR.NE.ICSN)  THEN 

__  PAINT*,  *Ai  £R*OR  OCCURS EO  In  IN'/ErTING  WUU.  MR*  * ,  MR  ,  »_IC  5N*  •  ,IC9M 
END  IF 

CALL  EQUAT£jHMlfWH3,IC3M,IC3H) 
c  NHl'aMUUl  SAVE  FOR  LA  TEE  ICrfPUTATIONS 

call  n4Tkwmi,hm2,:c3h,:c3m,**olo.am4>  _ 

C  NH4*  (HUUIJ  (3NT1  IC3.N  X  IHOLO 
C  NO*  CALL  AICCATI  EOLATION  SOLVER 

C-LL  NATi(3n»ah*,IHIl0»IC?H,Ih0L0»Ai'i31 

C  *H3»3n  (ALUI  HINT)  _'HCLO  X  IHCLQ  _ 

CALL  NAIC(:HCL3,>FRI'i'»-H3,4XXS^H,..H2,-V6» 

c  wM2*KCSSPh  IHOLO  <  IHQlD 

C  WHSaFH-aM^UUDO'TMKCSSPNI-— I  OJNT  USE  THIS  SESULT 
mSG*  *<0SS?H  -3°.  THE  OETES-IMSTIC  CONT.iOLv.EA  IS* 

IC*5 

_ NSAV»nOIH1 _ _ 

NO  I  Ml* .,01* 

CALL  NMATr0(WH2,iH0L0,lH0L0,IC.KlN,K0UT,NCIN,N0:Hl) 

C  NO*  CALCULATE  OPTIMAL  GAIN  MATRIX  GCSTAR,  NOT?  I  NE£0  THE 

C  NEGATIVE  CF  GCSTi.R  FOR  T-E  CCNTSCL  LAN  G£N£R AT IC  F  FRC*  A N  LOG 

c  controller,  ano  this  4 ill  3E  the  gcx  required  in  the  perfocmance 

C _ ANJLYSn  ROUTINE  _  _ 

NO  Ini*  MSA  7  ' 

C  NC*  HAVE  KCSSPN  ,  CALCULATE  GCSTR*NUUI CoHT  (KCSS*M>**aUT> 

C  RECALL  WUUI  IN  U ,11 
Cl*1.3 

call  NAT4AHh,4M2,IC3H,IHCL0,IHCL0,HHh) 

_ CALL  TRANS2(IHQlO,ICBN,4XU,lh3>  _  _ 

CALL  NAOOl  <103*1, IHOLO, W*4  ,HM3,HM2,Ci> 

CALL  NAT1(HN1,4H2,IC3H,;C3N. IHOLO, GCSTR)  _ 

nsav*noihi 

NOIH1* NOI M 
IC*5 

C  GCSTR  ICON  X  IHOLO _ 

c  . .  “ . -  “  ~ 

HS3*  *Th£  OPTICAL  STE40Y  STATE  FEE09ACX  GAIN  MATRIX,  GCSTR* 

CALL  H, 1AT 10 (GCSTR, IC3M, IHOLO, 10, <IN  ,K3UT,n0IM,N0IM1) 

NO I  Ml* MS A  V 


005423 

o  c  5  *  ilV*  A 

035-43 

5C5-50 

005*63 

005479 


:i5L83 
015-90 
:o55o; 
c:s5ta 
31552 J 
"355  533" 

0  05  54j^—  A 

535553 

005563 

3C557]]—  A 

035539 

3J5595}-  A 

0C5600 


3C5510 

005620 

335633 

005640 


035653 

335667)-  A 

335670 

3:5660 

005590 

305703 

095710 

305720 

035733 

0C57LC 

35575X1-  A 

005760 

CC577TT  . 

0  Cf  7  83j  A 

305793 

105300 

005  HO 

0C5J23 

005330 

3C534J 

0C5  (Q-  A 

C0536C 


ENO 

'*  blcx  cxftr" 

SUa.RCUTlNS  CKFTR (FM»G*»  7  ,HH  ,M2*OTS,RKF5S  ,C.**l,'nM2,' 
lWH3,**4,NNj,H46,lRFH,:s.HN,  ICGM. F2, H2 , 3* , IC5*» 
c  calling  program  HUST  supplt  EIGHT  WORK  SPACE  ASSAYS 
c 

CTH IS  .ROUTINE  CALCULATES  THE  KALrAs  FILTER  GAI  ,S  NH£n 
C  GIVEN  The  FI,**,  GN  AnO  E  HAT-ICES  ANO  THE  NUMBER  CF 
C  OE  TESHIMSTIC  STATES.  THE  CONTROLLER  «CJEL  MUST  9E 
C  S’ECIFIsa  SUCH  THAT  All  the  HETESHINISTIC  states  APPEAR 
C  FIRST  Ano  TOGETHER,  That  IS 

CO/OT  (XltXco  «  »»^K  «  i»^jlT*r  1  j  S*  . 

C  <X>  ♦  <U>  ♦  <*> 


197 


0 1)  5  5  7  0 
005503 
0C5393 
055902 
0C5P13 
il  05  920 
005  933 
0C5940 
3C5953 
0  2596- 
005  373 
555982 
0  55  993 
5.6333 


•  .N  .*• 


»'*..** 


:s  n-<  < 


I  C  *  -  2  32  Gi  ;:5U3 

I  c  •'♦i-i  *:  t^riugh  <<  n  =  T£s n  ,;stic  states  j.g  r»i  r.b.z: 

i  c  ri "Aining  states  a?e  stoihastii.  =•  i  * s  <  x  *,  a *ic  =:  :s  n-«  <  3:6:3: 

I  c  M-K,  rt\0  it.32.JNO  G  2  i,£  PARTITIONED  ACCORQI NSLY .  356341 

I  C  THIS  ROUTINE  FIRST  S T- IPS  OFF  Th£  OETERHINSTIC  3TJT£S  T-Es  ICnpuTES  3353S; 

j  CANO  tETUAnS _ < _JjL MSN  FIUT£9  GJlf.SjFC  =  THE  RS-AInInG  STATES. _  :C6:6: 

!C  f*f  <ALFiN  FILTER  » A  IMS  eCR  "THE  OsTERHiNSTIC  ST4SS  AGE  SET  TO'  ZERO  '  306373 
i  C  A NO  TH£  KAw.NAN  FILTER  GAIN  THAT  IS  RETURNED  IS _  C  336383 

["c  -  -  .  pxfss  aafcToo 

1  c  WHERE  TH£  OIHSMSIQ.N  OF  TH£  Z £;0  V £C TOP  IS  <  ANO_THf_RKF  SS  IS  THE  _  3C6110 

,  C  STEAOY  SfATS  KALMAN  FILTER  GAIN  HATR IX  POR'THe  N-K  STOCHASTIC  STATES. 0C6113 

!_C _ Th;S_AUGHENTEO  MATRIX  is  fifTUTNEO  in  RKFSS  806123 

;  C  also  NOTE' THAT  in  "OROER  TT3  GEN  £  PATE  THE  KALMAN  FILTER.  ONLY  3C6133 

I  c  MEASUREMENTS  OF  STACHASTIC  STATES  ARE  NEEOEO  SO  THE  H  MATRIX  IS  006140 

:  C  REOUCEO  ACC3RCOINGLY .  "  306150 

CHARACTER  MSG*63 , NSGi*l  356163 

OINENSION  F2 1  NO  IN  .NO  IN)  .H2  (NCI.M.NOIM)  ,FH  (NO  IM.NOIM  ,  GN(  NO  IN.NOIM)  .  3  56173 

j _ 1 _ R  (  NOIH.  NOI.N  > .  WN  (NOIM.NOIM)  *WNi  (NO  IM.NOlM)  ,Q  ( KOI  K.  NO  IN  »  .  3C6U0 

'  1  WhZCNOIm.nOIN)  ,Wm3(;.OIH.NCIm)  .WMi.  (NOIM.nOIh)  ,Wti5(  nOIM.NCI!*)  036193 

i  1  ,W»*b(  NOIM.NOID  316  203 

REAL  RKFSS ( NO IM*  NO IMI  ,3M(N0IH,NDIW)  3  36  213 

_  OINENSION  COHl(l) «CCM2(1I _  356225 

I  CCN.Nwl  /.NAIN2/CON2  '*  . .  336230 

COMMON  /NAIm/nOIN. mOImi.COhi  336243 

|  COMMON  ✓  INQU/  KIN,  xOUT'.'kPUNCW  33  6  253 

j  COMMON  /MAUN5/  NSG  036  262 

C  ’  0C6273 

I  C***K4LM4n  FILTER  STEtOY  STATE  GAIN— — MODULE  »  2  03623C 

I  C  006293 

j_C _ aKFSS»  (PMSSMHHT)  (RI),  WHERE  PH  IS  TN£  STEACY  STATE  SOLUTION  TO  _TH  0  26  330 

,  C  RICCATI  EAUATION  0(?.N)/0tsFK(Fii)«PH(F?iTM>6?(QMGi(n  -  "  '  0C6315 

C  _  PN(NhT)  (RI1  ( HNM  PM) _  056320 

i  C  .  “  . . .  ‘  "  3C6333 

C  3  36  343 

C  *******CELET£  DETERMINISTIC  STATES,  Af.O  — TRANSPOSE  THE  F2  336  350 

C  MATRIX  FOR  THE  PICATTI  S2L3E^_  SINJ3E  IT_  TRANSPOSES  Th£  CALLING  ARRAY*  GC5363 
•  WRITflKOOr,-)  'IF  YOU  PLAN  TO  USE  THE  00YLE  "AN0  'STEIN  TECHNIQUE  F05G6373 

_ 1R  THIS  RUN  YOU  CAY  WISH  TO  ^COIFY  THE  /ALUE  CF  NUHOTS,  THE  NUM9E3  336380 

1  OF  OETERHI.NISTIC  STATES.  QC  *OU  WANT  TO  CHANGE  NUNOTS?  Y  OR  M036393 

_ 1>*  0  36-.03 

REAO  (KIN.11) KSGl  '  “  056*13 

NUNS  AV  * NUNOTS  3C6428 

IF  (  MSG  l.EQ  .  ' Y  ')  THEN  '  """  *"  556433 

M»ITE(<0UT,«l 'ENTER  THE  NEW  VALUE  OF  MJMQTS  FOR  THIS  RUN*'  056440 

REAO (KIN,*) NUNOTS  306453 

ENO  IF  036-63 

IDS* NUNOTS  *1  GC647G 

_  00  2112  I*I0S,JRFW _  _  956  483 

II »i -NUNOTS"  '  "  '  036493 

00  2112  J*nS,IRFw  336533 

JJ* J-NUNOTS  3265 13 

1  2112  F2IJJ, II)»FM(I,J)  056520 

I°.F2  *IRFM-NUmOTS  056530 

_ 00  2113_I*  1. IRNrt _ CG6543 

00  "211*3  J**IOS . IRFM  056555 

JJ* J-NUHOTS  306563 

2113  H2(X,JJ)*HN(I.J)  036570 

C  NOW  form  32, G2  536585 

00  2114  I* IOS . iRFf*  056593 

_ II*Ij-NUNOTS _ _  _  3C6602 

00  2114~ j»l,;C3N“  *  C  36613 

2114  WMl (II,J)*GN(t,j)  056523 

C  WMl  *G2  ZRF2  X  tCS.N  3  366  JO 

05  2115  I* 1 3S »I?F k  036643 

ii*i-numots  ::655o 

OC  2115  J*1.:C3N  32666) 


•  *  •  *  KT  '+A 


•  *»*•  *  *  *  l  *  *  *  ►  *  »  *  •  *  j»  *  m 


5 


\4 


a 


2115  W-..CII.  J)*8M(I,  Jl  ::S573 

C  »*■.  *52  I*F2  <  IC3H  3:6=93 

0C6590 

CALL  MATS  i:RF2,ICG.M.W'*1»Q,WM21  3J6733 

C  WN2«Gm  (II  «GmTI  IRF2  X  IRF  2  --USEQ  AS  *3»IM  <LIS*han  *ICCATI  6-3UT  JnE  006710 

_  t»9IT£l<0UT,*»  *03  T3L  «I1H  TC  mJOIFY  Q  5t  TH  £  OCYLs  ANO  ST-IN  TEC‘II3C672C 

1QUE.  f  09  N>»  3C6733 

RE1Q  <<IN»11)NSG1  _  _  _  0C6743 

11  FORMATUl)  ~  0C6753 

IF  <PSG  l.EO. *Y*>  THEN  9067^3 

CAU.  04Sl(Wl2tWM:.,WMl,ICaM.NN3,ISF2)  006773—0 

_ £N3  IF _  _ _  _  _  _ 306783 

HT«1  0 3 6 7 9C 

CALL  EQUATE (WN1 .  R *ISM2  *  IBM 2)  0C6400 

C  GNlNY  DESTROYS  THE  CALLING  ASSAY  006812 

_  CALL  G.'llHtf  CI9H2,:-H2.«.H1.AH3<HB,HT)  3C6823 

IF  (HR.NE.IRH2)  Tf£N  ~  "  306130 

WRITEU3UT,*)  *MR*«,nR.*IRM2**.IPH2  30614 1 

MSirr«OUT»*)'*A-I\V£.CSc  IS  FCULEQ  UF*  ""  306351 

ENO  IF  _  _ _  _  3:6850 

C  WM3*  Rf  IRH2  X  IS  M2  ""  .  306173" 

CALL  TRANS2  < IRH2  #I3F2«H2«WM4)  _  006383 

C  WM4*  M2T  IRF2  X  ISH2  3C6890 

CALw  MATKWMA.WMJ.  ISF2,ISH2,ISH2,LH»J  036900 

~C  NMS*  H2flRIf  Tar 2  'X  I®H2  .  . .  306913 

CALL  .HA  T1 (WHS  »H2»  IRF2* IR“2» IRF2.WM3)  306323 

C  WNJ*  M2HRIMM2)  IRFJ  *  IRF2  U06933 

CALL  R.9iC<I9F2,F2»H»3.HM2,nr6,4M4>  _  _  306340 

~C  NOW  CALL  RICC4TI  EQUATION  S0L7EST0  GET  PMSS  996950 

C  WM6*PMSS  IRF  2  X  I?F2  016969 

CALL  HAtlC WH6 »WM5 tIRFZt IRF2*l’RM2«"WNi)  —  -  006973 

C  NNlaRKFSS  ISF2  X  I? M2  096960 

10*3  036999 

C  FORM  RKFSS  WITH  ZEROS  AOOEO  FOR  DETER.  STATES.  337303 

PRINT*,  *,iUHOTS*»  .NUHOTS  337  313 

_  IF  (NUMOTS.N£.3)THEN  _  _  _  _  _  337029 

00  2119  J*1»ISHP  . . .  . . "  OCT  ISO 

00  2116  X*l*NUMOTS  _  __  _  037343 

2118  RKFSSII,J)*9  097353 

00  2119  I*IOS.IRFii  037360 

IX*I-MUHOTS  -----  907373 

2119  R*FSS<I.U)»WM1<II,  J) _  337  36  3 

ELSE  "  "  “  *  007390 

CALL  £QUATe<RKFSS,WMl,IRFM,ISHN)  _  _  0G7103 

ENO  IF  "  .  .  307113 

MSG* 'STEADY  STATE  KALMAN  FILTER  GAIN  MATRIX.RKFSS*  097123 

CALL  MMAT 10 (RKFSS »IRFm,IRMM»IC»<IN»  KOUT .NOIM.NQIM)  307133 

NUHOTS* SUMS AV  GOT  140 

c  . . .  ......  -  -  . "o or  150 

ENO  _ _  007 163 

•  OECK  FRHAUG  007 173 

SU9SCUTXNS  FSHAUGIO,S.FT,5T,GCZ.HT,GCX,3CZ.FC,SCY,aCY,GT,XO,PC,  337183 
lFA  . 8A*GA  .Q A.GUA .WM1  ,W'*2  .WA  «MM9, WMC ,WMO, MH£  »  WfiF  ,  007193" 

IMXA,FX4,RA,PXVA,GCZA,IRY , IFLGC Z . IFLGSO)  _  0C7233_ 

"C  THIS  ROUTINE  FORMS  A  SET  OF  AUGHENTSO  MATRICES  NESOcO  3Y  THE  ""  007219 
C  OSRFORKANCE  ANALYSIS  ROUTINES  037 22“ 

OZ  ME  NS  ION  Q(NOlM,NOI.M),R(NOlM,NOlM)  ,  FT  I  NO  IM  ,101.41  007233 

1  »6T ( NOIH.NOIM) *GCZ ( NQIM .NO IP I »MT (NOZM.NOIMI .GCX CNOIM.NOINI  .  007243 

1  9CZ< NOIH.NOIM)  .FCtNOIM.NOlM) ,3CY( NOIH.NOIM)  ,GT ( NO IH.NOIM)  ,  337253 

l  XO  <NOIM)  tPO  (NOXM.NQIM)  .WMKNOIN.NOIH)  ,WN2  (NOIN.NOIH)  337263 

OINSNSICN  FA(N0IH2,N0IH2)  .8AIN0IH2.N0IH2)  ,GAI,-.0Ir2,N0IN2)  ,  .  007273 

1  QA<MIIH2.N0IH2I .HMAINOIM2.NOIM2) .NM8INOIM2 .NOIH2)  ,  007283 

1  WMCt  N  JI  H2.NQI  M2  t  .  WMO(NOIN2.NO:m2)  ,WH£  ( NOH*2  .  N3IM2  )  ,W.HF  3C729Q 

1  (NOIN*  NOXmI.GCY  (NOIM.NQIM)  .F<ACN0IM2,N0I)>2),S1(NCIH2,N0IM2».  3  37  239 

1  GCZA  (NOIN2.NOIM2)  .? x  V A  ( 'I QIm2*nO! M2)  .QUA  {*101 M2 . f»0I  M2)  337  113 

®£Al  HX4(N0IM2)  007123 
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:  ri  T  £  G£  -4  IFUGCZ 
CHARACTER  NSG«55 
DIMENSION  CO.MKII  ,CCM2C.) 
c:  1.-C.4  /Mil  i-»/.-40H2,-J0Ii3 

COMMON  /NAIN2/COM2 
C3NMCN  _/MAIM1_/NOIM,>IDIMI,CCm1  _ 
/  INOU/  <IN,<0UT,<3U\CH 
/NAUN3 /  MSG 


COMMON 

ca  NMC.N 

CCMMCN" /M4IN6/  IC3T ,IC3m,  ICFA.ICGA.ICGM,! CGT.ICQa.IRFA,  IRFM.IRFT, 
IIRHT,IRQA.IC.LQG,ISHM,NUmOTS 

MRITECKOUT «•) *  ENTER  4  5  IF  »CU  HANT  ALL  THE  AUGMENTED  MATRICES 

1INTSC  OUT »  A  7  »OR  NO  MATRICES  TO  8£  PRINTEO** _ 

r.EAO  «IN.  *>rO  007450 

i.rfa»irft»i,rfm  337460 

NSAV1*N0IM  ■  0C7473 


307333 
2*7  34  ? 

0:7350 

u :736: 
337373 
337333 
007395 
3C7-02 
CC7413 
337423 
PS307433 
0C7443 


NSAV2*N0I**i 

NSAV3*N0IM2 

NSAV4*N0IM3 

C 

C***FORN  AUGMENTED  MATRICES  THAT  A®E  REQUIRED  WHEN  FORMING  XA 

c  ha* t nt  \#t> t  implies  that  ca*  q  : 

C  JR 

C  "  "  '  . 

C  FORM  <JA  IRQA  X  IRQA,  ISGd«IRHT*ICGM 

c  for  equivalent-discrete  Time  systems'  irqa*  i'rft*i.r«t  - 
IF{IFLGSO.EQ.3)ThEN 

IRQ*  ICGT  '  - . - . - 

ELSE 

IRQ*  IRFT  '■  "  . 

END  IF 

ffcf— 2/0  3  1*1, i=Q 
00  275  3  J«1,IRHT 

2733  NM1 ( I« Jl*3  *  .  ” 

00  273  4  I*t,I.RHT 

'00  2734  J*l, IRQ  ' 

2734  WM2(r,Jt«3 


Q  07  482 
3Q749C 
337333 
337310 
337320 
3  37  33  3 
037343 
307350 
337363 
0C7  37C 
037530 
337393 
037603 
00761.3 
037623 
307633 
007543 
007650 
C 37663 
3C7673 
037533 


IF3«N*1  307630' 

_ MOIM3»NSAv3 _  0377  03 

N0IM2*NSAY1  "  307713' 

CALL  AUGHAT(H.M2fR»WM0»IFCRN,IRNT» IRQ* I.RHT  » IRHT>  007723 

CALL  AUGMAT|QtHMlfHMC«IFORM,IRQ,IRQtIRQ,ISHT)  0C7730 

_ ICaA*IRQ4lRHT  337743 

IRQA*ICQ4  '  '  007T53 

IF0KM*2  _  _  _  0C7760 

N0IM2*NSAV3  “  "  3C7773 

CALL  AUGMAT(VMC*MMOtQA«IFC.RM, IRQ, iCQA,IFHT, IRQA)  307703 

MSG**  THE  AUGMENTEO  Q  MATRIX  IS  ,0 A  *  537790 

_  CALL  M.1ATI0(QA,:.RQA,I.RQA,I0,XIN,KCUT,NSAV3,NS4V3»  3G73Q2 

lMA*NSA/3-iRFT  337313' 

C  INITIALIZE  °XA  MXA  ANO  STORAGE  VARIABLES  357923 

00  5135  II*XA*1,NSAV3  337930 

5105  MXA<IMXAI*0  _  _ _ _  3  27  943 

00  5103  I  MX A*1 , 1.RpT  ~  007353 

5100  MXA<IMX4)*XC«IM»A1  307363 

MSG*  *  fME  INITIAL  X A  VECTOR  IS*  ""  007373 

_ CAL,L  _MVECI0<rtXA,I.RFA,i0_,KlN>xCU_T,!LSAv3)_  _  337380 

00  91*1  IFX  4*1 ,  IRFT  '  . .  ~  '  ‘  OC  7393 

00  3102  JPXA*1, IRFT  307903 

5132  PX  A  (IPX! , JPXA I *R0 ( IPX 4 , JPX A )  QC7910 

_ 00_5  10  1  JPX*t,I.MA  007923 

jPXA«jPX4lRFT  '  0C7930 

5121  PX  A  C  IPX  A,  JPXA)*  3  _  _  0C7943 

00  3153  IPX*1 , IMA  '  0G7953 

IPXA*IPX*IRFT  007963 

00  5 15  3  J®XA*1,:«F4  0  27973 

515!  °X  A ( IP  <A, JPX4) *L  5*798: 
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1 


MSG**  TH£  IMITIAL  C2/A»:4NC£  MATRIX,  ?XA  is* 

CALL  H  .<4TiO<3x4,Ir- A  F  A  ,  I  w  ,  *1  >«  ,  <G  UT  , 'IS  Ay  3  ,  >|S  A  V  3  > 

c***p<va  caliu.ation—  -.icu;-.£3  csly  first  time  tm-3'jg-  «_oop 


C  PXVA*  0T(GCZ» 

C  1/2  5. 

C _ _  9CZ 

*C  TO  USE  THE  XL  IENMAN  MULTIPLf  ROUTINES',  Tn£  OSCLASSo  DIMENSION  0? 
C  ARRAY  ARGUMENTS  MUST  3£  TH£  SAMS.  THEREFORE  IT  IS  NECESSARY  TO 

C  F0  .RM  GCZ  A  SUCH  THAT  GCZA  ( I  ,J )  «GCZ  C I.  J»  FOR  I*1,IRHT,  ANO  J*l, 

C  IC0M.  ANO  ZERO  ELSEWHERE 

C  TH£  SArtc  REASON  REQUIRES  CALCULATION  OF  R  A 
IT*NSAV3-IRMT 
jf*NSAV3-IC8M 

_ 00  6113  IG»1, IRH T _ 

00  6014  JG«1*IC0M 

6014  GCZA  (IG» JG>  *GCZ  < IG» JG1 
00  6*13  JG«1, JT 

JGA» IC3P+JG 
6013  GCZA (IS, JG A)*u 

_  _  00  6015  I G» 1 , IT  _ 

IS  I*  IG*IRMT 

OC  6  015  JG* 1«  NSA  V  3  _  _ _ 

6015  GCZA  (IGI t  JGI * J 

_ IR*NSAV1-IRHT_ _ _ 

00  6017  IRI»1,IRH*T  . . 

00  6017  JRI»1  »IRMT_  _ 

6017  RA ( IRX  ,  JRI ) *R  ( 19 1 »  JR  I  > 

00  6016  JRI*1,IR  _ 

JRJ*JRI«-IRMT 

6016  RA(IRt,J*J»*0 _ 

00  6010  IRI=1,IR 

_  IRIZsIRIhIRHT  _  _ 

00  6013  JR  1*1, NS A V3 

6O10_  RA(IRII,JRI»*fl  _  _  _  _ 

C  RA  *  S  IN  UPPER  LEFT  PARTI TICN .ZERO  ELSEWHERE 
_  IF ( (  IFLGCZ . £0 . 3  J . ANC. ( IfLSSO . EG . 3  U  THEN 
C  CALCULATE  PXVA'CNlV  FCR  GCZ  NOT  EQUAL  TO  ZERO  MATRIX  ANO*  NOT  FOR  *S-Q 
C  RECALL  THAT  ( 3T (GCZ)  8CZ) T  IS  THE  RIGHR  PARTITION  CF  GA 
00  6  30  3  IPXA*l,IRHT 

_ IPA*  IPX  A-  ICGT _ _ 

00  630  J  JPX  4*1, IRFA 

60CJ  PXVA  (JPXA,IPXAI»GA(JPXA ,I?A) _ 

Cla.  5 

N0IH*NSAV3 _ _  _ 

N0IHl*NSA.’3>i 

_ _ CALL  NSCALS(WMF,?XVA,IRFA,IRNT,C1> 

CALL  HATKWNF  ,HA,*RFA,I£HT,:r'hT,PXVA> 

C  PVXAaPXA <T  IRFA  X  IRMT 

NSG*  *  CROSS  COVARIANCE,  PXVA'iS*  . 

CALL  N.IATIOIPXVA, IRFA, IRHT, IC  , KIN, KJUT,NSAV3,NSAvJ) 

'  ENO  IF 


FA*  FA11  FA12  *FTH9T(SCZ> (NT) 
*FA21  FA 22  *8CZ(HT) 


9T(GCX» 

FC 


WHERE  GCZ  IS  THE  GAIN  MATRIX  THAT  ACTS_OI.REC  TLY  ON  THE  MEASUREMENT 
VECTOR,  ANO  GCX  IS'THf"GAIN  MATRIX  THATS  ACTS  CN  TM£  CONTROLLER 
STATE  ESTIMATES. •••••THESE  MUST  0E  SUPPLIEO  8Y  THE  GAIN  MATRIX 
ROUTINE------- - C  * 


C***FORN  FA 

NO I Nl* NS AV 1*1 
N0IN«NSAV1 

c 


337995 
3  C  4  3  3  J 
333313 
OU  3  23 
3  33  333 
00d3«»0 
303353 
3  3  6  j  6  3 
350070 
3C3530 
003093 
000103 
053113 
3C012C 
000133 
030140 
3C015O 
0C3160 
0  0317  3* 
003100 
OC013O 
GC023C 
050213 
35S223 
000230 
300243 
003253 
030263 
300  270 
JJO0  23  3_ 
300290 
:js»30 
000315 
030325 
000330 
333*43 
303  353* 
0C3363 
000*73 
303303 
000390 
DC  3-0  3 
000410 
300420 
030-30 
OC0-45 
0  33-53 
000463 
350470 
003-33 
050490 
303503_ 
350513 
050523 
000530 
300543 
55055: 
003563 
0  C  0  573 
030563 
'350593 
003603 
000613 
0C6625 
000633 
3C0£4) 


nnnn 


c>wi  •<iri(3r,GCZ»;t"T,ic3T,TpMr,H>!ij 
C  WMt»3T(SCZ>  ISFT  «  ISmT 

CAUL  MAT1<AM1,HT,IR?T.:RHT,IRFT,H*2> 

C  mm2*  9T(GCZ»MT  IRFT  X  IRFT 
Ci»1.3 

_ call  haookirft , :  =ft,ft,h*2 

C  WM1*  FTli  IRFT  X  IRFT 

IF  <IC3M.NE.IC3T> THEN 

MRIT£(KOUT,*> *ICdM«»,:C3M,»  IC9T*‘,IC3T 

HRITS(<3UT,»> '9T  ANC  3M  ARE  NCT  THE  SAME  SIZE-  KILL  CAUSE 
ENO  IF 

CAUL  MATi < 3T .SCX  « IRFT .IC3T.IRFM.MM2)  ■ 

“5  HM2«FA12  IRFT  XIRFF 

_ IFORH*!  _ _ _  _ _  _ 

N0I.N2*?JSAV1 

_ CALL  AUGM4T(HN1,HM2,WMA,IFO?M,IRFT,.1>AFT.IRFT.IRFh> 

C  WM4*  (FAIL  FA12>  I AFT  X  IRFT«IRFn‘ 

_ CALL  MATKaCZ.HT.IRFM.IRHT.IBFT.Hhl)  _  _ _ 

C  KMl«‘FA2i  Is.  FM  X  I  AFT 

CALL  AUGMAT  (WM1.FC  «MM3  « IF  CRF* IRFM*  IuPT »IRFM*I-F  m) 

C  WM9»  t FAZi  FA22)  IRFM  X  IRFf*IRPT 
NOIHZ*NSA33 

IF3»F«2  '  "" 

IRFA*IRFT  *IRFM 

- . . 

CALL  AUGMAT<WM4,WM6  ,FA . IFORF . IRFT , IRFA , IRFM  ,ICFA) 
msg«'the  ausms.nteo  F  MATRIX  FA  IS*  *  - 

CALL  MMATIO(FA.IRFA. IFF A • IO.KIN.KOUT . NSAV3. NS AV  3) 

C  fa  IRFA  X  IFF A 


0:3552 
333960 
0  Is 57  j 
0:3580 
0C3530 
0037  00 
O.i’13 
3C872Q 
3CS733 
iSRORS'  538740 


C***FORF  a  a  -  -  -  FOR  AEGUL"Afo'R"'C'ASe  ,  NO'f  REQUIRED  T*S 
CALu  MATI  (  3T  »GCY  .IRFT .  IC  3T  .IRY.MM1) 

C  KM1»  3T  (GOT  >  IRFT  X  ISY  ~ 

IF03F*2 
NOI  f*2*NSAV  1 

CAuL  AUGMAT  <K**1,9CY,3A,  IF  OR*.  IFF  T.IRY.IRFF.  IRY) 
HSC*  *  ThI~1uGMcNT  =  0  3  MATRIX  9 A, "IS* 

CALL  MMATI0<3A, IRFA  .1ST ,1 5  ,<IN ,<OUT ,NSAV 3 ,NSA V3> 

C '  34  IRFA " X  I.RY  --  — 


c***form  GA 


GA>  GT 
*  0 


3T (GCZ) 
8CZ 


CALL  MATKBT .GCZ  »IRFT»IC3MfIRMT  .HM1) 

C  MMl*  3T (GCZ)  IRFT  X  IRMT 
IFORF'ii 

CALL  AUGMATIGT.MMl, KMC. IFORF,IRFT, IRQ, IRFT, IRMT) 

C  RECALL  IRO*ICGt  FJR  CONTINUOUS  SYS,*IRFT  FCR  S-Q  SYS 
C  MMC*  <GT  3T  (GCZ)  )  _I»FT_  X_  IRMT+IFQ 
00  3331  IR«1,I.RFM 

_  _ 00  3  301  I3»l.  IRQ _ _  __  __ 

3001  MM1(IR,IC)«0  ‘ 

CALL  AUGNAT(HM1 . dCZtWMQ. J FOR P.IRFNi^RO.IRFN .IRMT) 
C  HMD*  ( 0  3CZ>  IRFM  X  IROAIRHT 

IC5A«IRCaIRHT  _ _ 

IP3RM-2 

NOIm2»NSAV3 

CALL  AUGMAT(HMC. WMO.GA, IFORF, IRFT.ICGA.IRFM.I CG A ) ' 
MSG«*  THE  AUGMENTED  G  MATRIX  GA  .  IS' 

CALL  MMAT:3(GA,IRFAtICGA,:0,FlN,«CUT,NSAV3,NSA^J) 
C  GA  IRFA  X  I CG  A 


GUA*5CZ(MT) 


303750 
J3876C_ 
008770 
008780 
008793 
3083 03 
053310 
C2S520 
0C8  333 
038840 
CC  8350 
338  36  3_ 
00887*3 
QC8383 
008390 
_£38900_ 
TCS 913 
528923 
008930 
03S9H3 
3C8  95  2* 
SI  3  963 
008971 
OCf  ia 0 
3C339G 
059030 
3  59315" 
009323 
339)33 
339343 
039353 
03936Q_ 
"5093  70“ 
039383 
309393 
009100 
009115 
009123 
309133 
009140 
309150 
009163 
309173 
309180 
039193 
039200 
039213 
009223 
009233 
009240 
03925) 
039  263 
039275 
009280 
335295 
•53973: 


I  *  *  A  «  *  #  X  . 


•  \  V 


v'  *.  -w 


NOlMaNSAv  1 
hOI-'la-iSAVi*: 

Ciui.  4ATKSCZ.HT  «IC3T,;fiHT*lrFT.w<ii) 

c  mm2*  GCZ04TI  ::sr  x  irft 

IFORHai 

_ Mor.^za.'isa  vi _  __ 

NOIM3*nSA«3 

CALL  AUGMAT<WM2,GCX.GUA,IF05M.IC3T,:fiFT,IC3N,IRFM) 

‘  mSG*»TH£  AUGMENTED  MATRIX  GL'A  IS* 

CAUL  NMATIO  (GUA,IC3T,:RFA,IC,KlN,<CUT,NSA^3,N$av3» 

C  GUA  ICST  X  IRFA 

C****»*AUGFgNT;3  SYSTEM  MATRICES  NOW  AVAILSLE  FOR  COMPUTATION _ 

"C 

NOXHaNSAtfl  _ _ _ 

NOI Nl*NSAV2 

_  N0IM2»N«AV3  _ _ _ _ 

N0IH3«N$AV4 

END 

*  OECK  PSRFAL 

SUBROUTINE  PERFAL <IRY,IFLSC2,MX A.GCY.GUA.PX A,PXVA,IFLGSO. 

IRA,  GCZA.rO  ,£A  T« IMTGA  ««M£ . WMF ,  FUU. MMl . WUOUT  ,  MX  TOUT  .P'JOUT  .PXTOUT, 
1MX AM  IN  t  .iXAji  AX  »?XTkI.N»PX  t,M  AX  ,  HUMlN,  MUHAX  .  PUMt N.PUM  AX  .  MU,  INT3  A, 
lUVlt'KVUr 
CHARACTER  MSG*60 
REAL  wNltN0lMtN0lP),S4T 

1  (NDIH2.N0I M2)  .INTGA  (N0I.M2  .NOTH’)  ,NM£(N0IM2, NDXM2)  , 
iWHF(M)lM2  .N0IM2)  .WV7U40IM2)  ,HV4  <NOI  M2)  , 

1  MXA(N0lM2) »PX A (N0IM2 » N9IH2 ) »PXVA (N0IM2. 

1  NO  IN  2)  .MUCUTINOlM)  .MxTOUT  <NOIM)\pxTGUTCNOIM>  .PUOUTCNOIM)  • 

_ 1  Y  0 1 NOI M3  )_♦  MXAmIN  t  *1 0 1 M )  .  HXA !*  AX  ( NO  I  HI  ,  MUM  N  <  NO 1  M )  ,  MU.MAX  C  NO  I.M I  , 

1  PXTillNlNOlM)  .PXTmAX(NOIM)  .PUMINtNOiN)  ."UNAa  (NQIM)  ,GCZA 
1_  (  NO  I  M2  .  NO  1 .12 )  ,  R  A  ( NO  1 12  .  NOI  M2  )  .  GU  A  (NO  I  M2  ,  NO  ZM2  )  ,  GCT  (NO  IN. 

A  NCIMI , INT9A (N0IM2.N0IM2) 

INTEGER  IFUGCZ  _ 

01  ME  NS  I  ON  COMIUI  ,C0M2<1) 

_ REAL  MUt.NClM)  ,PUU  ( N0IM2.N3IH2) _ _ 

CGMMCN  /RNTIM/  RVffM*  .OELTJ  M 

_ CO MMCN  _/MA I';i»  /NCI M2. N0IM3 _ _ 

COMMON  /M4IN2/C0M2 

COMMON  /MAINl/NOIM.NOINl.CQMt 

CO  MMCN  /  INOU/  KIN.KOUT.KPUNCH 

_ COMMON  /HAUNS/  MSG  _ _ _  _  _ 

COMMON/ MXV6/IC3T . IC3m» ICFA,  ICGA . ICGM.ICGT. ICCA . IFF A .I.RFM.IRPT . 
IIRHT .1 RQA • I O.LOG . ZR HM« NUHO TS 
NS  AW  1«  MO  IN 


MSAV2*M0IM1 
NSAv  3*M0IH2 
NSAw-^N0IM3 


£••••?££ form ANCs  analysis  ROUTINE 


339  u: 

3:9723 

039730 

a  .‘9  740 

009750 

0:936 3 

009370 

CS978Q 

009393 

Q«9*3 3 

339-10 

009*20 

009*30 

QG9-40 

009*50 

309463 

009*73 

009430 

039493 

009533 

039510 

009523 

009530 

50934J 

2C9553 

QC9560 

009573 

009553 

IC  9590 

QC96Q  3 

0C9613 

009520 

0C9633 

039643 

009653 

309663 

339673 

3C9533 

3C9690 

009700 

3 3971 T 

0G9720_ 

009730 

009740 

049)53 

009760 

009770 

009780 

30979 J 

809500 

009513 

C3932C 


THIS  IS  a  CONTINUOUS  tine  MEASUREMENT  PERFORMANCE  ANALYSIS  009513 

ROUTINE  FOR  evaluating  CONTINUOUS  TIME  CONTROL  SYSTEMS  0*IV£N  3Y  C2932C 
WHITE  GAUSSIAN  NOISE.  "  IT  CONFUTES  THE  MEAN  ANO  COVARIANCE  OF  THE039830 
OF  THE  TPUTHrOOEL  STATES  ,THC  CONTROLLER  STATES. ANO  TH£  C3NTROLS_OC994) 
GEME3ATE0.  A  SET  OF  AUGMENTS!)  MATRICES  IS  USED  TO  00"  THE  009553 

CALCULATIONS— Y*<XT  USTARIT, _  XA»(XT  XM)T  ..  TM£  PERFCR MANCE0C9863 

ANALYSIS  ROUTINE  IS  OS VELCFEO  IN  A  MASTERS  TH£S£S  FOR  AIR  FORCE  009673 
INSTITUTE  OF  TECHNOLOGY  SY  ERIC  LLCYO,  TITLE  *«CBUST  CONTROL  039583 
SYSTEM  OESIGN*  0C939G 


C***MXA  »®X  A  CALCULATION--  THE  ME  AH  ANO  COVARIANCE  CF  THE  XA  V: 
C  FCUNO  USING  SOLUTION  FORHS  CF  THE  PROPAGATION  EQUATOnS 

C  KuISHMAN  ROUTINES  ARE  USSO  TO  PROViOE  THE  SOLUTIONS 

C  IN  TH£  FOLLOWING  TWO  EOS.  THE  FIeST  CCCURRANCs  OF  FXA  OR  MX  A 
C  IS  Th£  / A w UE  AT  T  I*£  T*0£LTI«,  THE  SECCNC  —  —  AT  TI.-S  T 


009870 

039880 

039390 

0a9900_ 

039913 

039923 

309933 

3C9940 

2 '995  2 

0C996: 


to'-  AlV  *  .  T>  •  >  ' 


»<AaEAT <px4)£att*intga 

1  .<  4  a  £  A  T  (  >XA)  *INT=A 

s££"  definitions' scli-'or  eat  ,intga,  intea 


MCT£  SINCE  THIS  PR OG ' a «  CONSIDERS  ONLY  THE  REGULATOR 
Y-TH£  DE3IRE0  INPUT- _ IS  ASSUMEO  »  ZERO _ 


:  ( £  (XO I 
PO 
) 


C  )  T  *(XO 


£ *TH£  EXPECTED  VALUE  OP £5 ATOP 


EXP  (PA  ’TIMS) 

IMT9A*  INT£G(£AT>9A  FOR  CONTINUOUS  TIME  SYSTEMS 
*  3AO  POR  OISCRSTE  SYSTEMS 

INTGA»  IN T (EAT (GA )OA (GA T)  SATT  >  POR  CONT  TIPS  SYSTEMS 

*"  GOA (CO  A) GOAT  “'POR  DISCRETE  TIp£  SYSTEMS 


LCOUNfH 

IrN«MMT<PNTIM£/OELTIrU 

H*ITE(OUT,a» 'ENTER  A  I  '  IF  YOU  WANT  NO  PRINTS 
1  AMO  MU  MATRICES  DURING  THE  PERF ORMANCE  ANALYSIS 
1  NUM8ER  OF  TIME  INCREMENTS  BSTNeEN  PRINTS  (  THERE 
1  TINE  INCREMENTS  IN  THIS  RUN) >  * 
~'.rsaq'(k*n*mipcnTC 
I?  ( IPCNTL ,£Q ,3 )  then 
IC*5 

ELSE  _ 

10*5  "  '  '  ”  . . 

EN3  IF 

do  T33  t~  Im*i,nSavi 
PUU ( IN»IM)  *3 


OF  PXA, 
•  ELSE 


APE  •, 


nu(IM*o 

MX  AMIN ( IN) a  3 
MX  A  PAX ( IN ) *3 
PXT MIN  (IN  1*0 

pxfM*x(TfiT*3r 

MUMlMIN)«0 
MUM A  X(  fN)~*  3 
PU  MAX t IN)  a Q 
PUNlM  IN)  *0 
CO NT INUE 


l  PLOT  P0INTS(MAX  130 J  PLOT  PCINTS)  THERE  ARE  ',IR>:,*  SA 

ts  REoussTEo^os-nTirs-TcrNiT -  - 

RSAQ  (KIMt* • IPLTPS  __ 

OELPLTaOELTlH'IPtTPS  ““  ‘  ~ 

00  3599  ITLHPal.IRM 


039973 
339RJ3 
3  3  9993 
313 ; 30 
CASE,  313313 

_ d  1 5  3  2  0  _ 

313333 

_ 213  240 _ 

OP  £.R  AT  OR  010  3  53 

CIO )63 
31007C 
010383 


010393 
013103 
019113 
_  010123 
313130 
013142 
013153' 
513160 
PUU,  MX A,  313173 
ENTER  THE  013133 
2RN» '  TOTAL 3 13 193" 
__  _  313  20  2 

313212' 
313  220 
'013230 
310  240 
010250 

_ 013260 

313273 
010280 
"  010290 
513393 
310313 
012  32C 

- jimr 

_  _  013343 

"010  353 
313 363 

.  010373 

__  _ 013383 

0  8£TH££n  Old  393 

.mPLE  PERIS0012-,00 
31941C 


IP(IC.E3.5)  THEN  _  _ _ _ 

JJ*ITLMP-1  " 

IPNTaM03( JJ.IPCNTL) 

IF  ( ( IPNT* EQ«] I ,OR • ( ITtHP, EQ . IPN) I  THEN 
TI  1e*  1  J*0£lTI M 
hsite(<out,*)'t:me*  ' ',t:me 

MSG* »  PXA* 

CALC  MMAT  10  (PX  A  ,3 ,3  ,IC  ,  KIN  , XCUT  ,NSA  «3  »>ISA  V3 ) 

HSG*  *  PUU* 

CALL  MMATI0(PUU,IC3H,:C3H,IC,KIN,K0UT,NSAV3,NSAV3I 
MSG*  'MX  A* 

CALL  M  4 £CI 0( MX  A*  3,1 0  «  KI N , KCUT,NSAV3> 

MSG*'MIJ» 

CALL  NVSCI0(MU»IC3H«I0, KIN, POUT, NS A VI) 

£*'d  IP 
£*)d  IP 

IDa  n  A.-iT  TO  STORE  POs  eLCTTt  XG  »  "XT  ,  PXY  ,  MU  •**  UU 


010420 
SIC  43d 

519440 
010450 
315  465 
010470 
013480 
"310490 
013500 
015513 
51552J 
51033]J>- 
313543 
013553 
01C560 

'0 10  5/31— 

31SE83 
013590 
513633 
3  i:si: 
01562: 


•  .N.VkX.v,'  ;• 


% 


9 


or  itfi  „h-*i,? 

H>  T„LT  (1— J  »«*>  A  (!»'=» 

PX  T-CTC^i  )*S3RT  <F*1<  Im=.(  I h- )  J 

ccnt:-iu£ 

OO  12*.  IMR«1*ICBK 
_NUOUmNfi>»MU  <HR  J 
P  OOU  T  1 1 nr i  *sort  < s  uult i  * r  ,  i  w r  n  ' 
continue 


NO  CROSS  COReELATICN  TSRFS  AP£  PLOTTSO  _ 

C  *  -  . - 

NOlHfc*NSAVl 

"IPTCT,.»H00I  JJ.IPwTPSI  ‘ 

IF  IXPTCTl.EQ.O)  THEN  _ 

CALL  STORED  (LOG*  RATINE, OELPLT ♦  LC0UNT,7 ,7 ,  1C  3K,ICBF, 

_ 1  NXTOUT,PXTOUT,MUOUT,PUOUT,AOIH6> 

LCOUNT»cCOUNT *1 
ENO  IF 

*C  NOTE  THAT  YO  IS  PcSTRICTEO  BY  VALUE  OF  LCCUNT  TO  6S  CONSTANT 

c  betheen  plot  points 

if  <lcount.ct.i:ccjthen 

C  RESET  LCCUNT 

LCOUNT*1030 
ENO  IF 

'C***UpGa‘TE  pxa,nxa 
c 
c 

__  N0Ifi*NSAV3  _ _ 

N0iri»NSAv3n 

_ CALt.  NAT3<IRFA,IRf A,£AT,PXA.hM£> _ 

Cl«1.0 

CALL  MA001<IRFA,IRFA.WMS,INT6A,PXA,Cli 
C***PXA  AT  n£H  TIME  NON  AVAILABLE 

C  HXA«  EATIH>A0>nNT  =  G(EAT(3AI  )  (YD)  _ _ _ 

00  181L  IK»1,IRFA 

wv3jj<j«j _ 

00  1.815  XK«1,IRFA 

_  00  1815  IJal«IRFA _  _ 

1815  ~WV3  ( IK ) «NV 3  CIKI ♦£  AT<lK,IJ )*HXA(lj>  "  “ 

_ 00  1812  IM.R*1 ,  IFFA _  _ _ 

1812  MVH  IHR)«INTBA (IMR ,1)  *Y0  (LCCUNT) 

_ 00  1813  IJ»1,I*FA _ 

1813  HX  A  ( IJ  >  «NV3  (IJ)+WVL(IJ1 
C***NXA  AT  NEH  TINE  NON  AVAILABLE 

C***HU,PUU  CALCULATION  FOe  ZERO  WEAK  MEASUREMENT  NOISE  .  ” 

C__  NU»GUA (NX A) lGCZ INVTI ♦GCT IYOJ •»»«PVT  ,TMt  HEAN  OF  NOISE  V  ASSUMED 
Xi«rOCLCOUNT» 

_ NOIr*NSAVl _ _ 

NOI Ml*  NSA  V  1*1 

CALL  MSCALE<MHl,GCr.:C3P.IRT,XI> 

C  NH1*  GCYCYO  ICBM  X  1 

_N0IH«NSAV3  _  _ 

NO  I  *1 1*  NS  A  V  3*1 

_ 00  1817  IJ»1,ICBH _ 

1817  NV3  CIJI«fi 

00  1816  IJ*1,XC8M 
OC  1316  IK>1,IRFA 

1816  MV3(U)sHV3IIJHGUAI:j,IK)*FXA(:k) 

C  NV3«GUA(HXA»  IC3H  X  1 

C  AOOEO  TO  WH1  ABOVE  TO  GET  HU _ _ _ 

00  329  I*1,IC9H 
329  NU(I)>HV3(I)*hh1(I«1I 

C  HU  I.RFA  X  1  ——NON  Av  AIL  A91E— — — 

C***PUU  CALCULATION, PUU*GUAIPX  A  I  GUAT*GUAJPXV  A  >GCZT*GCZ<PXVA)GUATl 
C  GCZ (R) GCZT 

CALL  MAT3<IC8k,IPFA,GUA,P*A,pUU) 


M 

dec*.: 
C1365T}-  M 
S 10  66  3 
ci:*7: 
513663 
ClCfc9U“  M 
31C7CI 
C1C71C 
oicrz: 
010733 
_cio7l: 
013753 
013760 
01C773J-M 
010783 
010*93 
01380: 
013810 
013823 
013833 
C 13  9L  3 
010850 

_ CIS  863 

010873  " 

CIS  883 
QIC  893 
010903 
C 1C  913 
_  013923 
01393}  ” 
010943 
010953 
_  010963 
0 1C 97C 

_ 01C983 

C10993" 
3113C3  _ 
011310 
C11S20 
011333 

_ Cli343_ 

C 11 3  5  3 
C11060 
01137C 

♦  a  0 113  85 

011393 

_ C11100 

011113' 
011123 
011133 
_ CHILD 

eiiT5:“ 

_ 011163 

31117: 
01118C 
C 11193 
011203 
011213 

_ C11223 

C 11233 
011243 
011253 
0 11 26  3 
011273 
011289 


mow 


.wv- <<<*..•. -v*. 


C  *U'J«Gui ip*a»&u4T  »  IC?*i 

C#*****I?wGCZ***** 

IF  c;rfcGC7.£3.,l  T  H 

C  s: SCI  SCI  NOT  EQUAL  To  Z£SC  SA_CU„ATE  OTHi* 

C*»»*»*I»c5CZ****** 

If  (Ifi.GSO.SQ. it  TM£m 
CTTlnT'  03  THIS  *3*  S-0  CACS 

CALL  HATl  (GUA.H4WA,:C3H,I?.f  A.IPd.NHF ) 

CALL  HATL  (WHF.GCZA.  IC3H.IAMT  .ICSH.HhC) 

Cl-1.9 

CALL  HA00llXC9n.XCBrt.FUU.H»£,VHP  ,C1> 

C  m»« 6UA(PXA»6UAT*6UHPXtfAI6C2T 

Call  hat* iccza.pxva. icon. xbht.xbpa.puui  * 

_ CALL  HATLlfUU.6UA.XCBH.XRfA.XCIT.HHEI 

CALL  HAOOtlXCCH.XCBH.HHE.HHf .FUU.Cl) 

C  fUUH6UA(»XA)6UAT«6UA<»XVA)6CZTL6CZtftfXA)6UAT 
EHQ  V 

CALL  HATJIXCBH.IRHT .6CZA.XA .HHE) 

Call  HAOOtlICBH,ICSH.HHC.*UU,HHf .cii 
call  CaUATEIfUU.HHf.XCBH.ICCH) 

ENO  If 

c***  huu  nch  available  xcbh  x  ice* 


5633  JCOHTIHUE 

'  oo  t«c  XH»*t,r  . . 

HA  TOUT (IHAI «HXA(INPJ 

12  G  HXTOUT(lHA»»SQ?T(fXA(*L?T!Hi.»»  . . 

oo  tzt  iH*»i,:csH 
huou  tTrsrnr^mwRi 

121  PUOUTIIHR  l»SOPdPUU  (IHR.Ii.fi)) 

CAlL  STO*EO(L96,kNT:-€ .0ElT:>.LC0UNT.7»7.:CBN,XC8». 
1  H«TOUT,PXTaUT(HUOUT,PU9Ur,fcOX«6> 

C  CALL  TdTTO».rO  HXTH'L^OUMT  «'?  INOICATc  THIS  OATA 

_ LC0UNt»»12 _ 

tALw  STWtS0(Lfl6.!5NTiH".0ci.t:»i,wC0UNTT77? .TCBH.TSei*. 
1  HATOUT .  PXT  OUT . HUOUT . PUOUT. KQIH6> 

N0IH-HSAV1 

_ H0IM1-HSAW2  _  _ 

N0lH2»MSArfJ 

H0XH3HNSAVL 


C11K.U 
cii3i: 

TIr.KS  OF  P'JU  3 II 322 

:iU3: 
C 11 3lC 
31135C 
31136* 
3113TC 

_  011380 

011393 

_ CllLjj 

oil Lie 
011L20 
011L33 
OIIlLO 
OULSC 

_ C11L60 

011*70 
011L8C 
C11L9Q 

elisor 

011510 

_  _ _ _01152: 

011530 
C 11 5l3 
0115?! 
C1156C 
311570 

_ 011  583 

C 11553 
811602 
011613 
011623 

PUN  COMPLETE  C 11633 

cii6l: 
31165C 
311662 
Oils  fti 
C 11 680 
C11S9C 
311703 


-2  = ( J 1  :  2) 


$ 


C  FJ=.M  T-t:  AUGMENTED  M i T -  I :• 

oc  i2 

OO  11  A««sltlCll 
u  i2  c : 1. 1: i > *ii ( i::> 

OC  12  XV*l,ICA2 
I VI* Iv ♦ICl 1 

'12  ~ 

return 

ENO  IF 

C  FORM  AUGMENTED  MATRIX  A3*!Ai  A2)T 
IF  A3*I RA1+IRA2 

_ ICA3*IGA1  _  _ 

00  1*  Halt  ICA3 
OC  13  III a 1 t I RA1 

13  A3(III«II)aAl(i::«i:) 

___  00  14  IV»1 t IRA2  _ 

Ik I>  IV* IRA  1 

14  A3 (I VI , II ) *A2 (IV  til) 

RETURN  -  -  -  *“  -  - 

ENO 

SU3RCUTINE  MVEC10!A,NUNSL,IC,KIN,K0UT,NDlF) 

C  THIS  SUBROUTINE  READS  PRINTS  ENTIRE  IPCRTIOKS  OF)  THE  VECTOR 

C  A,  0 SPENDING  ON  THE  VALUE  OR  —10—.  10*1  —  -READ  ONLY 

C  10*2— REAO  ANO  PRINT .  10*3  BEAO  SELECTED  VALUE.  10*4 

"C  StAO  ANO  PfilNt' SELECT £0  VALUE? 

C  __  10*5— PRINT  ONLY 

C  “TO  USE  10*3  OS  4  THE  CASLuING  PROGRAM  MUST  INITIALZE  THE  w£C. 
c  ••••••THIS  ROUTINE  SETS  IO*J—  WHEN  NO  DATA  IN  INPUT  FILE 

C  . '  ~  * .  . 

CREAO  IS  FROM  UNIT  SPECIFIED  9Y  CALLING  PROGRAM  In  Kir., WRITE  IS  TC 
C  KOUT.NOIM  IS  THc  OECLAREO  OIf£F?ICN  OF  A  IN  THE  CALLING 

C  PROG  AH  _  _ 

CHARACTER  HSG»62 

_ DIMENSION  ACNCIM) _ 

COMMON  /NAUN5  /  MSG 

_ IF  MIO.EO.ll .Ok .<10. £0.2)1  THEN _ 

~C  REAO  ENTIRE  VECTOR  * 

_ WRITEKOUT,*)  'ENTER  *, NUMEL, 'ELEMENTS** 

REAO  KIN, ••EN0*29MA(I)  ,I*1,NU«£L) 

_ ENO  IF  _  _ 

IF  Itt.EQ.l)  THEN" 

_ RETURN _ 

ENO  IF 

IF  <<XO.EQ.3I.OR.<XC.EQ.4).CF.<XO.EQ.e>n  Then 
C  REAO  ONLY  SELECTED  ELEMENTS.  THE  FIRST  NUMBER  Cn  EACH  CARD 
C  IS  THE  SU9SCRIPT,  THE  SECOND  IS  THE  DATA  ENTRY 


C********NCTE  ONLY  ONE  OATA  ENTRY  PER  CARO 

C** ******  FIRST  CARO  MUST  CONTAIN  THE  TOTAL  NUMBERS  CF  ENTRIES  TO  BE 
C  REAO 

_ IFIIC.NE.6)  GO  TO  4  _  _ 

00  3  I*‘l,NOIM 

3  A IX>*0.  _  _  _ 

4  CONT  H;UE 

_ WPITg!OUT,«)  *  ENTER  THE  ELEMENT  NUMBER  ,_THfN  III.  VALUER _ 

5  REAO KIN,*,£N0*29)I, ENTRY 


IF(Z.LE.O)  SO  TO  23 
IF  (I.GT.NOIKI  GO  TO  5 
A(I)*EmTRY 
IF  <20.E0.n)THEN 

NCITE(<0UT«33) *  « _ 

WRITEIKOUT  ,•)  ;1S3 

WRITE! <OUT »•) *  ELEMENT  NUMBER  ,  ENTRY** 
WRITE! OUT  ,11)  I,  A  II) 

ENO  IF  _ _ 

GO  TO  5 
20  CONTINUE 


curb: 

0 11 97  C 

oii3s: 

C119SC 
01220: 
:i2:i: 
012:20 
512030 
C 12340 
012350 
C12J61 
C 12070 

012 :«c 

012590 
312100 
012110 
01212: 
01213: 
01214C 
012153 
012160 
01217: 
012180 
012190" 
01220C 
01221C 
012220 
012230 
0 12243 
012250" 
0 1226 j 
012270 
0 1228 j 
C12290 
012390 
512310 
012320 
C1233C 
012  J4C 
012350 
012360 


: 1239C 
:i<4o: 
012415 
012420 
01243C 
012*40 


C 1217: 
012382”* 


0 12455 
3 1246C 
012470' 
C 12480 


31249: 
0 125  OC 
012513 
012520 
0125^2 


M 


012340 
01255: 
31256C 
012570 
01258 
0125  _ 
012603 


nh- 


M 


% 

s' 


207 


v 

v 

< 


•*.  ^ ^ •  ■ 


•-*  ^ 


oo  oo;  o  n|o  njo  cvn  nlnolo  nr>o|  I  i«  i  wo 


*  t  TU 

•  f.n  :f 

IF  (i:j.t1.2l.j:.c:.£0.f||  Tw£:. 

C  TC  GET  M£R£  I3«2  OR  5  SO  P* IN T  CUT  £nTI«£  VECTOF 

writeckout, j;i»  • 

_  HPITtlKOUT,*! MSG  _  _ 

MRITECKOUT.*)  •  THE  SECTOR  MAS  '•  .NUMEL  *  ELEMENTS* 

MRITECKOUT. 22) <41 1) ,I*i,NUM£L> 

RETURN 

ENO  IF _  _ 

RETURN 

29  PRINT*.  *£N0  OF  OAT  REACHED  DURING  INPUT  IN  HVECIC* 

j_ 

•••♦••THIS  ROUTINE  SETS  I0»0~—  WHEN  NO  DATA  IN  XnFUT  FILE 
3  FORI* AT  <A1G  »/) 

_ 11  FORMAT  <  I<*»  13X  .  El 2.6  )_ 

22  FORMAT <10 < 1JC IX. E12.6) « i • /) I 
RETURN 

Eno 

OECK  MMATIO 

SUBROUTINE  MMATIO  CA.IR,  IC.IC.KlN.KOUT.NOIM.NOIMl) . 

CHARACTER  MSG*63 
DIMENSION  A  <  NOI  M.  NDI Ml) 

COMMON  /MAUN5 /  MSG 

this  subroutine  reaos  ano/or  PrinT?  the  matfix  a  depending  on  the 

VALUE  OF  10. _ IT  .REAOS  _FRCH  UNIT  SPECIFIED  BY  KIN  AnO  WRITES  TO  UNIT 

KOUT.  “  10*1— READ  ENIME' ARRAY  10*  2 — AO  ANO  PR* NT  ENTIRE 


ARRAY.  IO««3—  SEAO  SELECTED  ELEMENTS  OF  A  "IC«U-— READ  AnT 

PRINT  SELECTED  ELEMENTS  OF  A  I0»5  - PRINT  ENTIRE  ARRAY _ 

NO IM.N0IM1  ARE  T Hi- 01 MANSIONS  OF  A  IN  THE" CALL INS  PROGR AN 

'••♦••"•NCTE  l?~  IOiTOtTw  The 'CALLING  PROGRAM  MUST  INITIALIZE 
THE  ENTIRE  ARRAY  BEFORE  CALL 


••♦♦••♦THIS  ROUTINE  SETS  10  *0 - WHEN  THE  INPUT  JILE  IS  EMPTY 

IF  <  <10. £0.1) .OR. <I0.EQ.2I )  THEN 
READ  ENTIRE  ARRAY  IN  FREE  FORmAT.ROw  MAJOR  ORDER 

_ MRITECKOUT.*)  ‘ENTER  ‘.CR’ICI.*  ARRAY  ELEMENTS  IN  ROW  MAJ  QRQER>  * 

READ  (KIN,* . EN0*29) <  <A  CX .J ) « Jsl . IC) . I«l» IR) 

ENO  IF _ _ 

IF  <10. EQ.il  THEN 
RETURN 
“  ENO  IF 

IF  <  <10 *E0.3)  .OR.  <XC<£Q.4t  .OR .CIO. EC. 61)  THEN 

READ  IN  SELECTEO  ELEMENTS  OF  A  .  " . 

THE  FIRST  CARO  IN  TW£  INPUT  STREAM  MUST  CONTAIN  THE  TOTAL 
NUMBER  OF  ELEMENTS TolE  READ  IN.  ONLY  ONE  ENTRY  PER  CARO. 

THE  FIRST  ITEM  ON  EACH  CARO  IS  THE  ROM .  THESECONO  IS  TH£_COL  JMHE 
LAST  ON  EACH  CARO  IS  THE  OAT  A  FOR  THAT  LOCATION 

_  FREE  FORMAT  IS  USED _ 

IFCC.Ne.6)  GO  TO  4 

00  45  M»1 » IR _ _ 

00  wE  N»l« IC 
A  <  M.  N)  *  j  •  J 
CONTINUE 

MRITE<KOUT,»l ‘ENTER  THE  ROM.INO  COLUMN  FOLLGMEO  eY  ITS  VALUE*  * 

^  RE  AO  <KIN»*.EN0«  29)11.  J, ENTRY 
IFC(2I.LE«Ci).OR.<J.lE.3))  GC  TO  2: 

IF  <  cii.GT.  IR)  .OR'.  <J  .GT.  IC) )  GC  TO  5 
A<II,J)«ENTPY 
IF  C10.EQ.4)  THEN 
MR I  TEC KOUT .33)*  • 

MR  I TE<  KOUT. •) MSS 

MFITECKOUt,*)  »  <»  .J,  »)«».ACII.J) _  _ 


;-i2si: 
31262. 
:i2t3. 
oi2<jt; 
C12553 
312563 
C 12 67 3 
012683 
012 69j 
6127C3 
01271C 
C1272i 
Ol‘273C' 
012743 
012753 
C12763 
012773 
012780 
'01279: 
012)33 
6 12! 10 
012820 
C12333 
J129L0 

oizeso 
_G1286  J 
012870 
012883 
212S9C 
_ci29o; 
012913 
012923 
012933 
C  129<*C 
012 95* 
012960 
012973 
C1298S 
012993 
013303 
013010 
013323 
'013030 
013343 
013053 
C 130671- 
01337T 
_01308C 
011393 
013103 
■'013113 
013123 
01313? 
013143 
013153 
01316C 
013173 
013180 
£1319* 
01320C 
“013  213 
C 13220 
013  23J, 
013243 
013253 
01326*. 


E*  3  IF  21327: 

GC  TC  5 

z:  COMT.NU*  H3293 

R£TtJ*'J  C  1330 2 

ENO  IF  01331C 

IF  I  (ZO.£S.2> .OR. (IC.EQ.5)  >  TL£N  01332C 

C  S’ 6  *  2  03  5  IP  HERS  SC  PRINT” EKTiRs'ARRAY  '  213330 

_ WRITE! <OUT ,33 ) *  •  _  413342 

WRITEIKOUT .*) MSG  013353 

WRITEIKOUT,*! «  MATRIX  SIZ£  IS  *,ZR,*  X  *,IC  013363 

00  4$  1*1,13  013370 

*9  WRITE  I  OUT  ,40)  !A !I«J)  «J*1«XC)  C1336C 

“S3  FORMAT IAlC,/) ~  013390 

44  FORMAT ( 5110 (IX* El 2.6) , I ,/) )  013400 

ENO  IP~  '  ”  0131,10 

RETURN  013420 

29  PRINT  *,*£N0  OP  OATA  REACHED  0URIK6  INPUT*  .  313430' 

C  *******THIS  ROUTINE  SETS  10  *0  — —  WHEN  THE  INPUT  PILE  IS  EMPTY  013443 
10*.  C13450 

RETURN  013*63 

ENO  "”  ”  013*73 

•  DECK  Cl OCRS  __  _  013*63 

SU3R0UTINE  CL9GR5 (GCStRV Fm»3M ,RKFSS,MN, GCX, GCY.GC2,  013493 

1BCY,ECI,PC»YO,RM,OM,PT,ST,6T,OT,RT,HT,IP.Y  .IFLGCZ.WMl  013503 

l  ,mmT.wmj,po.gm,wh*,wn5  ,hh”6,  '013513" 

1  WVl,WV2,MUU,WXX,X0,WX'J.WH7,HM8>  Cl352u 

C  THIS  routine  PERFORMS  SET  UP’  PCR’"0'SIK(T-ThE—CCNTINUOUS  time  '  ”  013533 

C  PERFORMANCE  analysis  FOR  ANLQG  REGULATOR  0135*3 

Ol  M£  KS I CNGCST  R  (  n’O’X M  , NOI M)  ,  Ft  (NOI H , NOI M)  .BhINOIM.NOIM) .PGIKOIH,  013553 
lNOlN),HM(NOIM,NaiHl,GCX(NOIP.NQZH),GCYCNOIH,NOIH) ,GCZ(N0IH,N0IH),  013563 

IBSVlkg’iH.NfflNi ,3CZ i'nOIh,  n o  im  > , fcTkoim, noi *>  ,yocnoim3)  ,wm (noi m ,  01357:” 

_ 1ND lM>  »NN2  (NOIM,  NDlMl  ,WH3l|i0lP  ,  NOIH)  ,FT|NOIM  ,NOlM»  ,  013560 

i  BT( KOIm.nOXH) ,GT (NOIM, kOXM)YmT (NOIH.NOIM) ,RM(NOIM,NOIH) ,  .  013593 

_ lOTJNOIN.NOtMl ,RTINDIN,NOtM),CNlNOlM,NDIM) .WVKNDIM) .HV2INOIM  013603 

l),XO!NOlH),GMINOXM,M)lH>  ,WUUINOIN,NOIH)  ,  '""013614 

_ 1.  MXX  (NOIM,  NOIM)  ,MHL«MOlM,jNOlPr,WHf  INOXN.NCIM)  ,  _  _  013622 

1  uMb  (NO  IN,  NOI  HI  ,  WXU(  NOIM, NOIM)  ,WH7  ( nOIM.NOI  M)  ,”nM6!NOIM,  NOIM}  013633 

DIMENSION  CQM1 ( II ,C0H2 ( 1)  S13643 

'CHARACTER  MSG*63~  ~  ”  013653 

_  INTEGER  IFLGCZ  _  C13660 

REAL  RKFSSt FOlNtNOIM)  ”  C1367C 

COMMON  /MA:nl/nOIM2,NOIM3  ei366C 

COMMON  /HAUN5/  MSG-  013690 

_ COMMON  /MA INI/  KDIM,N0IM1  ,CCM1 _ _  _  013700 

COMMON  /MAI  N2/  COM2  .  ..  -  —  013713 

_ COMMCN  /RNTIM/RNTIME,OE*T:m  013720 

COMMON  /XNOU/  KIN,KOUT,KPUNCM  013733 

COMMON  /HAIN6/IC  BT , IC  BM ,IC  F A , IC GA ,ICGH, IC  GT  .ICCR.IRPA.IRFM.IPPT  ,  0 1374  0 

1  I RHT «IR  QA  ,1 0.L  QG,IRHK  , NUMQTS .  -  -  -  -  01375C 

WRITEIKOUT,*) *00  YOU  WANT  TO  CALCULATE  EIGENVALUES  OF  THE  TRUTH  M001376C 
lOEL  ANO  CONTROLLE*  MODEL  ”  F  MATRICES,  V  OR  N> *  013770 

_ P.EAO  (KIN, 23,£r«0* 2533)  MSG  _  _  21378^ 

23  FORMAT  (All  013790 

IP  INSG.EO.*Y»)  THEN  213533 

WRITEIKOUT,*)  •  •  . . .  “  0133ic 

WRITEIKOUT,*) *TH£  EIGENVALUES  OP  THE  TRUTH  MOOEL  P  MATRIX*  C13520 

CALL  M£XGN(PT,WV1,WV2,IRPT, HMD  213533 

WRITS! ROUT,*) *THE  EIGENVALUES  OP  THE  CONT.  MODEL  P  MATRIX*  013040 

CAwi.  N£IGKCPM,WV1,WV2,IRPM,HMH  01385C 

_ ENO  IF  _  _  __  __  013860 

WRXTEIKOUT  »•)  'COLORED"  INPUT  NOISE  IY  OR'nV  >*  013673 

P.EAO  (KIN, 23) MSG  013580 

IHOLO* IPPM  313993 

IPIMSG.EQ,  *N»)GO  J0_2563 _  01390S 

CALL  CNOISEIPM,GM,HM,9m,0*',IRPM,I».MM,ICGmTiC3k,WM1,'hh2,kM3)  3 12 91 3 

2903  Call  CKFT*.  IFM.GH.R N.HH,  NUMQTS, RKPSS,QM,WM1,  HM2.HM3,  WM*.  kM;  ,LM6. _ 013023 
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►  v 


■--  .-  -• 


7^.%  wi  .-•  .-e  ,v  -.  ■,>  :n  “tvt :■>; 


;< 

$ 


cv£ 

fe 


.■» 

'.v'y 


25 

35 


i  I?*'*,  C3.-T,  CCV.C-C2.  ?*.:C9*> 

6CZ.GO,  2*i  CALL  TO  C<*Tt  i  =  £  US£0  A3  OlM-Y  AP=£vS  *2  ,r.’ 

CA^i.  C0TC0N<F*,i)«  .W** ,«UU .GCSTR,I«CwO.IC3K.  »H1  ,Hn2,hh3.  •>*-,  » m5. 
lNMb,t.AtJ,W««7.WN3) 

IF  (IKJLO.EO.IRFh)  GC  TO  35 

_  ICHsJWOi.0*! _ 

OC  25  I*1,IC3n  ~  .  ' 

og  2  5  j*:ch,:sfh 
GCSTS(I,J>*0. 

CONTINUE 

NRXTEIKOUT,*) 'ENTER  THE  TOTAL  RUN  TIKE  ANO  THE  TIKE  INCREMENT** 
RE  AO (KIN,*, ENO* 29 33)  RNTIKS  .QSLTIH _  _  _ 


L»*l 

CALL  IDNT ( IRF H.WH1.C1) 


C  NM1*-I  IRFH  X  IRFH 

CALL  HAT1 CGCSTR.NK1.ICBH, 1RFH.IRFK.GCXJ 
IO«E 

MSG*  *GCX  F  CLL  OHS,  GCY.GCZ  SET*C • 


C 

C 


290  3 


<£> 


:i??3: 

cu9s: 
C1396G' 
C 13573 
013990 
013990 
OH.OQO 
514513 
OLA  023, 
01*033 
31*343 
01*050 
014360 
014370 
014390 
01*390 
JJ1410C 
014113 
01*120 
C1A13C 
01414C 
014153 
C 14160 

1FlGCZ»1  '014172" 

IFLGCZ*!  INDICATES  6C2  IS  SET  TO  ZERO--PREF  A 6ALTSIS  ROUTINE  USES  IF01410C 

C 14190 

00_2533  1*1.1305  _ _ 014240 

Ybm*o  '  01*210 

IRTai  014220 

014230 
014243 
014250 
01*260 
014270 
01*200 
01-290 
014300 
014310 
014320 
014330 
0 1434C 
0*14350' 
014360 
01437* 
014300 
014 390 


CALL  HMAT  10 C(?^X, I CBhTIRFM.I'C.XIK, KOUT,NOIH,NO IN) 

C  _NOT£^****_l  OTHER_GAIA  HATRICES.GC2.4N0  GCY  SHOULD  BE  CALCULATED  IN 
C  THIS  HOOULE  FOR  USE  IN  THE  FERFCRr.ANCE  ANALYSIS  ROUTINE. 

OO  2902  III*1,IC8H  _ 

. .  00  2942  IIi:«l.IRHN 

2902  GCZUII.IIII)*? 


00  1723  1*1 »I CBN 
00  1723  J*1.XRY 

1723~‘GCV<I,JI*3  "  "  . 

C  FORK  BCY 

00  1732  l*i,I»FH 

00  1732  J*1,IRY _ _ _ 

1702  BCY ( I. J)*? 

C  TO  IS  ALLOHEO  TO  ONLY  BE  a  SCALAF  AT  THIS  TIKE 
C  F0RH3CZ 

_ Cl*  1 .3  _ _ _ 

"CALL  EOUAf E  TBCZ.RKFSS.  IRFK , IK  HH) 

_ MSG* *3CZ  FOLLOMS,BCY*Q  • _ 


CALL  MHAT 10IBCZ, IRFH.IRHh, IC, KIN.KOUT.NOIH, NO IK) 
FORM  FC  _ 


CALL  HATH  BH.GCX , IRFh, ICBH.IRFH.HH1) 

CALL  H AOOl (IRFH, IRFH, FH.MH1.NH2. Cl) 

MRITECKOUT,*) •  » 

MRITS(KOUT .*) *03  YOU  NANT  TO  CALCULATE  THE  EIGENVALUES  ^F  _THE^  C3NTC1440C 

V 


OR  N>» 


IINUOUS-TImE  LO  CONTROLLER? 

READ  KI 4,  23)  HSG  _ 

IF  (HSG.EQ. *Y  *)  THEN 

MRITE  IKOUT ,*) • THE  EIGENVALUES  THAT  CORRESPOND  TO  THE  POLES 
1  THE  CONTINUOUSLY IKE  LO  CONTROLLER  ARE...* 

_  CALL _ HEIGN(MN2»NV1»NV 2»IRFK,MHy _ 

END  IF  ■  ' 

Cl*-t 


OF 


014*10 

014*23 

314*3? 

51**40 

014*50 

314-63 


014-7J 

_  _  014-60 

CALL  HATURKFSS.Hh.IRF'h.IRHK.IRFh.MHI)  *  '  014*90 

WR2TE<KOUT.») *  •  _  014500 

NRITE  CKOUT,*) *00  YOU  MANT  'TC  CALCULATE  THE  POLES  OF  THE  CONTINU414510 
tOUS-HME  KALHAN  FILTER?  Y  OR  N>  *  01*520 

RE AO (KIN, 23) HSG  "  014333“ 

IF(«G.EQ.*Y*>  THEN  01*540 

CALL  HAOOKIRFH.IPFh.Fk.MKI  .MHT.Cl)  014553 


MRITE (KOUT,*)*THE  EIGENVALUES  THAT  ARE  THE 
10US-TINE  KALHAN  FILTER  APE....* 

CALL  NSICN  (MH7,4Vl,MV2,IRFK,WH9) 


PO*ES  OF  THE  CNOTINU014563 

51*570 

01*59? 


s.v 

■*  -V, 
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CAL*  MADOl  «I-r  1.1 -f  M...M2,  rf*  ltfC.CH 

HSG*  •  PC  PCS  TM*  LOG  C CNT CF-LLE  S  IS* 

CALL  KrfiTIOlFC,  IRFK,I?.Fri,  IC  .KIN  ,<CU  T.NOlM.f.DI  M> 
NSITe(KOUT,*) '  ' 


31-593 

*  «  _  i.  ft  r 


Cl-613 

01-523 

Sl-530 


WPIT£(<OUT.*) '00  VOU  *ISH  TC  CALCULATE  TH£  EIGENVALUES  of  THE  log  81-6-j 


1C0NT  nOLLtP  F  MATRIX? 
r£AD(KZN«Z3)  HSG 
IF  (KSG.tO. *Y  ')  THEN 
WRIT£(K3UT,*) '  • 


3 1-653 
01-663 
01-673 
01-660 


WFITE(KOUT»*) 'TH£  EIGENVALUES  OF  THE  LOG  CONTROLLED  F  MATRIX  A*E'  01-69G 


CALL  HEIGN(FC,WV1.WV2,IRFN,WM1)  _ _ 

ENO  IF 

RETURN  _  _ _  _____ 

2933 ' 10*0 

ENO  _ _ 

•  DECK  OASl 

SU3RCUTI NE  OASl (  GQGT ,3M  «V ,XCBM,  MM3  * IRFH) 

DIMENSION  GOG T (  NO Irt  ,  NO  I M)  ,  BK  ( NDZ  M . N  DIM I »  V (NOIM,  NO IM ) , ' 

1  Wm3(NOXH*NOIH) « CONI (1 > , COM2 (1 ) 

C  THIS  SU9RCUTI NE  HOOIFIES  GOGT  AND  RETURNS  THE  MODIFIED 
C  VALUE  IN  GOGT,  WHERE  GOGT  IS  USEO  IN  TH£  NATHAN  FILTER 

C  GAIN  CALCULATIONS.  Th£  HODS  ARE  IN  ACCORCANCE  WITH  THE 

C  THE  TECHNIQUE  DEVELOPED  BY  OCYLE  ANO  STEIN  IN  ’’ROBUSTNESS 
WlYfroasERVERS-.I EE E  TRANS.  CN  AUTO.  CONTROL. VOIL  AC2-. 

C  NO.  -,AUG.  79.PGS  607-611. 


THE  VALUE  RETURNED  IN  GOGT  IS  QQ  .  WHERE  CQ  IS 


QQ*GQGT-SQ<  SQ>  BH ( V (BHTt 


SO  IS  A  SCALAR  OESIGN  PARAMETER,  THAT  AS  IT  APPROACHES 
“INFINITY,  CAUSES  THE  LOG  CONTROLLER  TO  RECOVER  THE  ROBUSTNESS 
PROPERTIES  CF  A  FULL  STATE  FESOB ACK  CONTROLLER. 


CTME  MATROX— V--  IS  ALSO  A  OESIGN,  PARAMETER  WITH  THE  REQUIREMENT 


_G1-73C_ 

civric 

01-720 
01-730 
61-7-0 
01-7SG 
01-768 
01-77C 
G  1-780 
01-790 
01-609 
G 1-518 
0 1-6  2G 
01-630' 
C1-8-G 
01-650 
01-660 
C1-67C 
C 1-860 
SI-693 
01-90G 
01-910 
01-920 
01-930 


THAT  IT  BE  POSITIVE  C£PIMT£. 


bh— -  is  the  controller  model  inputdi-9lo 


“hATRUT;  SOGt  ---'JOhE  CONTROLLER  MODEL  INPUT~NCISE  STRENGTH 


01-950 


MATRIX  OH,  PRENULTIPIEO  BY  GM  ANO  POST  HUTIPLXEO  BY  GMT  WHERE  GM  IS  01-960 


THE “INPUT  NOIESE  MATRIX,  '  01-970 

CHARACTER  MS6*6G  01-980 

COMMON  /MAINl/NOIM,NOIHl,COHi  "  01-99G 

COHMCN  /MAINE/  COM2 _ 015S0:_ 

COMMCN  /INOU'/  WIN, ROUT, KPUNCN  015  010 

_ COHMCN  /HAUN5/  MSG  _  01532G 

Wc.ITE(KOUT  ,111  •  •  015330 

WRITECKOUT,*! 'THIS  ROUTINE  MCCIFIES  THE  VALUE  CF  Gh(OM>GMT  C150-0 

1  USEO  IN  CALCULATING  THE  KALMAN  FILTER  GAIN,  FKFSS. *  C1535C 

WrITS(KOUT,*) 'THE  HOOIFIEO  Q  IS  *  GM)QM)GMT*SO*SQ(BM> V(SMT)MHERE  015360 
~T  SQ  IS  A  SCALAR  OESIGN'  PARAMETER  ANC  V  IS  A  POSITIVE  DEFINITE  015  37G 
1MATRIX  OESIGN  PARAMETER.  THE  LARGER  SQ,  THE  MCRE  P3BUST  THE  CCNT»CC1508G 
1L  SYSTEM  WILL  BE.'  01539C 

OO  5  INP*1,10G0  _ _  _ _  _  01510C 

MFITEf  KOUT ,  HI  *  •  “  015110 

FORMAT  (A10  ,/l  _ _ _ _  _  _  0  X5 12c 

“  WRITEIKOUT,*) 'Inter  1-TO  IN^uTTO,  2-T3  INPUT  V  S-  fOCS^tU.ITE  MOOC1E133 
IIFIEO  QQ,  --  TO  EXIT  THIS  «CUTINE>'  0151-8 

REAO  (KIN,*  )  ZSEL  015150 

GO  TO  (1,2,3,-) ISEL  015169 

MP.ITE(KOUT ,  11)  *  •  015170 

_ WPITE(KOUT,*) 'ENTER  SQ>0— >* _  _  015160 

RE AO  (KIN, *)SQ "‘  .  G15 193 

_ GO  TC  5  _  8 15  2 0 G 

WRZT£(KOUT ,11) *  '  015 21C 

WRITE  (KOUT,*)'V  IS  INIALlZEO  TD  .ZERO  UPON  ENTRY  INTO  Tm;s  OPTIO01522C 
1H*  -  .  -  015233 

00  7  I*  1. NOIM  _ _ _ 0152-0. 


.nV'jV’v  vV  •*  «■.**.•* •  ■*.  ■*. 


s  % 


& 


$ 


A 


fe 


Ks 

yS 

:v 


A- 


•  »*> 
-  *  v 


§£y 


3 

C 


00  7  Jai.NOI- 
W  C ,J) -c 

WRITS(K0UT,*l  *£nT  s*  I/O  OPTiCN  F0-  POSITIVE  DEF  v<SE£  INPUT  ROUT! ft 
l£)  >  * 

R£40(KIn»*>IC 

HSG»*0£SISN  PARAMETER  V  MATRIX  ENTRIES* 

“CALL  MMAT  :6'CV.2C5h,iC3MiiC.KIN,<bUT,NOlH,NO:n»' 

G°  TO  5 

CALL  M AT3 ( IRF H, IC §N ,3m» V  ,  MM3) 

MH3*Bh( V) BMT  IRFh  X  IRFH 
SQl*SQ*SQ 

CALL  NAD01(IRFH.IRFH,G0ST,MM3,V,SQ1) 

V  X  "irf'm  NOW  CONTAINS  the  hoo.  VALUE  —  QG 


MSG* *THS  DOYLE  ANO  STEIN  MOCIFEO  00  MATRIX  IS* 
"TO*  5 


CALL  NMATIOIV,IRFN,IRFN, IC,KIN.KOyj,NOlM,NDlM) 
5  "  CONTINUE 

4  CONTINUE 

C  ScTTS  ACCEPTABLE  "SO  PUT  "INTO  'fiCGT 
00  2  L  I*1,IRFM 
00 '2w  J*1,IRFm 
20  GOGT (Z,J)*V(I,J> 

RETURN 
END 


C 

C 

c" 

c 


SUBROUTINE  rY"lNTGTPHl7TNTGAtlNT8A.WME;GA70A.FA,3A,iRFA,ICGA.IRY» 
llRQAI _  ______ 

Thist subroutine  s ets  up” the  necessa ry  integrals  fcr  use  by 

the  PERFORMANCE  ANAL.  ROUTINE.  TH£  STATE  TRANSITION  MATRIX, 
INTEG  CEAT (GA)  QA  (GAT)  EATT) , 

NMs  is  a  dummy  work  space 


TXP(Fa»TImEI*EAT, 
XNTEGIEAT  (9AI). 


ANO 


REAL  PHKNOIMZ,  )0Im2) . I  NT  GA (K0IM2, N0IM2) «  XNTBA (N0IM2«N0XN2I  , 
1  WM£(NDIM2,KQIH2> ,OA(NOIM2,NOIM2) ,BA(N0XM2,NQIH2) , 

IGA  (i,OI  H2«N0XH2)  »F A (NDIK2, NDIM2) 

DIMENSION  C0MK1I  ,C0M2(U  _ _  _  _ 

COMHCN/MAINI/NOIH , N0IM1 , C0M1 
COMMON/ MAI N2/  COM2 


COMMON  /INOU/  NIN,KOUT,KPUNCH 
COMMON  /RNTIM/RNTIME.OELTIM _ 


COMMON  /MA’N*./N0IM2,N0IM3 
C***FORM  GA(OA)GAT  —NEED  FOR  KLISNMA N  RO L'TINE 

c 

_ NSAV 1*  NOlM _ 


NSAV2*N0XM1 

N0lM*N3lM2 

N0lMi*N0lM2*l 


CALL  OSCRTURFA.FA,  CElTIM,InTGA,WME,14> 
C  NME*INT (EAT) 

_ CALL  MATl  ( WHS .BA ,IRFA.IRFA,IRY,INTBA) _ 

JNT (EAT) 3A 


C  I NT  BA*  INT (EAT) BA  I9FA  XIRY  NEEOEO  IN  MX  A  UPOATE 
CALL  mAT3(IRFA,IRQA,GA,0A,PHI)  _ 

C'PHI*GA(QA) (GAT)  IRFA  X  IRFA 

CALL  INTEG (IRFA, FA^PMI,INTGA,0ELTIM) 

C  PHI*EXP(FA)  IRFA  X  IRFA 

C  I  NT  GA*I  NTEGR  A  *  _  (  EXP  (FA)  (GA)  (QA)  (GATT)  (EXP(FA)  T)  )  IRFA 

C  '  ----  -  -  . -  -  - 

noim*nsavi  _ 

N0I Ml* NSAV 2 

_  RETURN _  _  _ 

ENO 


A _ I®F  A 


•  DECK  OSCRTZ 


C 

c 

c 


SUBROUTINE'  OSCRTZ  (MMi, PHI  m",bcyo,  bozo  ,irYm  ,OEL'TI  M  ,FC  ,  BCY  ,  ■ 

1  IRY  ,3CZ , IRHM,PHI T,0T0,8T0,GT , 0T,FT,8T,IRFT ,ICGT, ICBT,IRMT, 

1RT0  ,RT , GCX ,IC3M) 

THIS.  ROUTINE  OISCRTIZES  A  CONTINUOUS  TIME  LOG  CONTROLLER  USING 
FIRST  6 ROE  S  APPROXIMATIONS  TO  THE  REOUIREO  INTEGRALS 
AND  PROVIDES  AN  EQUIVALENT  DISCRETE  TIME  REPRESENTATION  OF  THE  T*UTM 


1 15 25  0 

zis26: 

C15275 

01526C 

C1529I 

015300 

015310 

C15  32G 

015  33^3-* 

015340 

015350 

015  360 

015 370 

015 300 

015390 

015400 

015*15  " 

C 15420 
C15430 
015441 
315450 
C1546C 
415473 
oi5*.ao 
c 15  49: 
015500 
ei55i: 
015  523 
015930 
015540 
015550 
015560 
015570 
015500 
015590 
015600 
0 15  6 1 : 

C 15 62; 
015635 
015643 
015650 
015660 
1 15 670 
015660 
015 69 C 
015700 
015710 
015 720 
C 15  7  3  C 
515740 
015750 
315 760 
015 770 
015783 

"015790” 

015300 

C 15  810 

315020 

015830 

0 15  940_ 

015853 

015963 

01507; 

C15800 

015995 

015903 
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C  M-OEL  SJR  USE  I  N  THE  PECriL  ROUTINE  2 15  91 ; 

rcAwNMi  <n3:m,N3:m)  ,ph;  *  (NC:r,m:  »)  ,33rO  (  Ml  N.NCIN)  ,  ;i;92.' 

1  =CZC(NOlM.NOIM>  ,FS(NCXm,NO>)  ,  3CY (NOlM.ND  Ik) ,  215933 

1  eSZCNDlM.MD:-)  .PHIT^OIM.NCI**)  ,9T0  «NOlH,NOI*l  ,  515  9<»u 

1  BTOINOIK. NOIM), GKNOIM, NOIM  ,CT <NOIF.NOIh)  ,  01595: 

_ i_ft<no:i.no:mi  ,  8T(no:m,nc:k)  ,sto  «no:n,no:m),  _  31596; 

i  GCX  (NDlM,  NOIM)  » RT  <NQIM ,  NOIM  ""  "  "  'CL5973 

REAL  COM1  (1) ,COM2  (U  S1596C 

CHARACTER  MSG*1  "  01599-j 

_ COHHCH/MAlNl/NOtHfNOlMJUCOHl  G163C3 

COMMCN/MA X N2/  COM2  ""  016315 

CONMCN/rAlN./NOlM2tNOIM3  01602; 

COMMON' 7XK0U/KXN«K0UT,KPUNCH  ”  -  C1633C 

Cl* 1.3  S16SAC 

CALL  IONT<2R.FM,WMl,Cl) . "  016050 

CALL  MAOOl <IRFM,IRFN«MNl,FC,PHlM,OELTrNI  016060 

C  PHIM«I4FC<0ELTIM)  1ST  OROER  APPRCX  TO  STATE  TRANS  MATRIX  OF  CONT  016370 

C  CALCULATE  GCX  *-GCSTR  C 16 3 SO 

ClV-iV:  C1639C 

C  RECALL  THAT  GCSTS  HAS  PASSED  INTC  THIS  ROUTINE  IN  3TD  0161CC 

CALL  NSCALE «GCX,8T0,ICBF,IRFh,C1)  016113 

Cl*1.0  01612C 

CALL  NSCALE<aCrO«ECy.IRFH,IRY*OEi.TIM)  016130 

C  8CY0  DISCRETE  TIME  APPROX  OF  3“Y  C161L3 

CALL  MSCALE(9CZD,BCZ,IRFM,lRHF',nELTIK>  '016153 

C  8CZD  OISCRETE  TIME  APPROX  OF  8CZ  _  016160 

NSAV3*NOIM2  01617C 

NO  I M2*  NOIM  016  ISC 

CALL  MYINTG(PHiT,0T0',ata,hKi;GT,0T,FT,8T,IRFT,ICGT,  IC3T,ICGT)  31619C 

N0lH2*MSAV3  016200 

C  PHI T  ,QTO  »8T0  ARE  EQUIV.  STSCRSTl  TIME  KEPRESTATIONS  CF  TRUTH  MODL  016210 

C  MATRZCEi  C 16220 

MPITE«KOUT,*l *  •  016230 

HRITE<KOUT,*> *  HAS  the  value  ENTERED  IN  RT  DURING  INPUT  A  CCNTI NUGO  162*»0 
1US  time  OR  A  DISCRETE  TIME  VALUE?  ENTER  A  C  FOR  CONTINUOUS  ,  A  016250 

_  1  0  FOR  DISCRETE  VALUE* * _ 01626C 

'*  REA«nKlN,l2»MSS  *  ~  ~  S 16 27 C 

12  FORMAT  (All  _  ___  516280 

'IF  (HSG.£Q.*C*)  THEN  .  '  ~  516293 

C1*1/0£LTIM  C16  3C3 

CALL  MSCALE(R.T0,RT,ZRKT,XRHT,C1>  016  310 

_ ELSE  C 16326 

CALL  EOUATE<RTO,RT,"lRHf;'lfiHT')  ~~  ~ "  .  016330 

ENO  IF  _  C 16 365 

C  RTO  IS  THE  OISCRETE  TIME  APPROX  CF  RT  C16350 

Cl*l  .2  516363 

CALL  I DNT { IRFT ,WM1 ,Cl)  C1637S 

C  WNl*GTO  «  I  C163S3 

ENO  .  "  '  '*  . .  ‘  . .  316393 

*  DECK  OLQGRS  C16«»0C 

SUBROUTINE  DLQGRS(GCX,GCY ,  6C2  ,BCY  ,  8CZ,PHI  T,  PHIC ,  RTO  ,GTD  ,  QTD,  C16-13 

_ JMBT0,FM,8M,9M,GF,RN,mm,GT ,QT,FT,9T,RT,MT,MXX,WUU,CCSTR,RKFSS»YO»  016.23 

1  IRY  «IFLSCZ ,WXU,WH1 (MM2 • HM3 *NMJ»*MK5  ,HVL , WV2 1  C16L3C 

CTHIS  SUBROUTINE  FORMATS  THE  SAKFLEO  OAT  A  CONTROLLER  INTO  THE  FORMAT  S16«*L3 
C  REQUtREC  BY  THE  PERFORMANCE  ANALYSIS  ROUTINE  '  D16V5C 

C  THE  FORMAT  IS  SRECIFZeO  IN  THE  COMMENT  STATEMENTS  IN  THE  COOE«  ANO  516.60 
C  ZN  FORE  OETAIL  IN  E,  LLOYD  S  MASTERS  THESISt 081 » AFI T.  31667; 

REAL  COM1 ( II  *  COM2  (1)  016L6C 

REAL  6CXINOIM»NOIMI,GCYINOIF,NDIM» ,GCZ(NDIM,NOI*> ,  016.93 

_ 18CY<N0IM,N0IM),  BCZ(NOIM«  nDIpI  »PHIT  IMDlM«NOIM)  ,  0165C3 

1  PH I C  C  NOI M.NO I M), RTO (NOIM, NCI f > ,GTOl NOIM, NOI *) ,  516513 

1QTOI  NOIM,  NOIM),  RTO )  NOIM,  NOIM , FM CNOIM, NOI M> •  516523 

1  BM(NOZh,NDIM),  QM(N0IM,NCIF) ,GM(N0IM,N0IM) ,  316533 

1  HV1 CNOIM), WV2<NOIM»,  _  _  _  0165M3 

1  RM(NOIm,nOIM) , HM (NOIM, NOI M) ,GT (N0IM,NDI M) ,  "  016553 

_ i  ot<no:m,no;m),  ft  <  ndim,  noim*bt  )noim,noim)  , _  ai656c 


3ftS0*! 


r  •  .*  V 

■  V  * 


Z  -;::£ 


1  ,hT  <';OlM,.«iOiM  ,«x*  CNOi'i.NOI'l  , 

I  K'J'JttJ  r^. *43111  ,GCSTR(N3Im,,\CIm»  ,  *<F53(.s3I-,.\0Ir), 

i  « <u  no :m. sol >u  ,*mknoi>*,  noim  ,«M2(  'iOi.i . nci  *•> , 

1  WM3  INDIM.NOrM)  .**>.  (NQIM.NOIM)  «WM5  (NOIM, NQIM) 

REAL  /0(NTIf3> 
integer  :£u :c z 

^MARACTE9NSG*63.wSGT*l,MSG2*i  '  " 

jCOMNCN  /«4INi/N0IH,N0:Hl,C0**l 
COMMON  /H4IN2/C0M2 
COMNCN/INCU/K IN,<C0T, KPUNCH 
— CCM.lCN  /MAIN4/N0IM2.N0IM3 
_ C0MNCN/MAUN5/MSG 

COMMON  /RNTIM/RKTIME.DELTIM . . 


.  16  5  7  . 

c  is  jj ; 

Cta 59: 
3 169  Q  » 
3  loolT 
3165  23 
3 1663 j 
316543 
316653 
C 1666 3 
C 16673 
016 563 
"J  1669  3 


COMMCM/FAtNo/ICeT.ICBM,  ICFA,ICGA,ICGM,ICGT,  ICOA,IRFA  ,IRFM,IRFT,  01670  0 


1  IRHT,IROA,IO,LGG,IRHI<,NUMOTS  316713 

WRIT £(KOUT ,*) 'COLORED  INPUT  NOISE  <Y  09  N>  >'  316723 

REAOKIN,  11IMSG  016730 

IHQL0«I»FM  316740 

imSG .EQ. •*• >  SO  TO-??  5i6753 

CAU.  CNOIS£<FM,GM,HM,3N,OM,IRFN,IRNfi,ICGM,IC3M,WMt,  WM2,  w  1 3 >  01676  3 

25  WRIT£<»<0UT,*> 'ENTER  THE"  TOTAL  RUN  tine  ANO  SAMPLE  TIME*'  016773 

a£aqik:n,*irntime,osltim  diets? 

11  FORMAT  CAil  316733 

C  CALCULATE  equivalent  CISC9ETE  TIN  E  VERSIONS  OF,  3M--aMO,Gt — GMO*I»  016300 
C  Cn~QHO,  ANO  PM  I M  THE  STATE  TRANSITION  MATRIX  FOR  FM  016310 

C ****** ********* ************************ •*•***•** •*•***••*•*•••*• •••••••JiS 323 

C  SINCE  WORKSPACE  IS  AT  A  PREMIUM.'  THE  TRUTH  hAOOEL  MATRICES  316830 

CPHIT.STO.GTD.QTO.RTO  WILL  3E  USEC  FOR  THEIR  CONTROLLER  MOOEl  316840 

C  COUNTER  FARTS  OURING  THIS  ROUTINE  9EFCRE  THE  EQUIVALENT  OISCRETE  016950 

C  TINE  TRUTH  MOCEL  IS  CONPUTEO.  AT  THAT  TI.iE  THERE  IS  NO  LONGEG  ANY  316863 

C  NEED  FOR  THOSE  CONTROLLER  MOOEL  MATRICE  SINCE  THE  CONTROLLER  IS  PUT  016370 

C  INTO  THE  PERF CNANNCc  ANALYSIS  FORMAT, PHIC  3CY, . SC 2  016330 

‘  016893 

NS4V3«NOIN2  _  _  316900 

N0I«2»U0IN  "  3 16 9 1C 

CALL  MY^NTG<PHIT *QTO»8TO  »RTC,GN,GM, FM»3M,IRFM,ICG8. IC8M ,ICGM>  016920 

C  sn  IS  USED  AS"  DUMMY  WORK  SPACE  IN  CALL  TQ'mYINTG  016933 

_ _NOlME*NSAV3  _  _  016940 

CALL  IONTCIRFN,GTO,i.C3JI  '  '  016950 

_ WPITE«<OUT,*l 'ENTER  A  C_IFJH£  J/ALUEO  ENTERED  INT0_  RM  IS  A  CONTIN016960 

1UCUS  TINE  VALUE  fC  FORM  THE  BASIS  OF  A.I  APPROXIMATE  OISCRETE  TIME  316970 


1  »N,SNT£R  A  0  OTHERWISE**  016990 

READ  (KIN ,  llfMSGl  *  316993 

IF  (MSGl.EQ. *C*>  THEN  _  017000 

”C  APPROX  INATE  RMO*RH/SAMPCr'TlME  317313 

_ C1«1/0SLT;n_  _  _ _ _ _ _  017323 

CALL  MSCAL£('RTd,RM,IRHM,iRNM,Ci»  “  *  317333 

_ ELSE _ _  _  _  _  _ _ _ _  017043 

C  THE  VALUE 'IN  RM  *S  01 SCR Eft  TIME  ALREADY  "  017353 

CAL.  £QUATE<RTO,RM,IRHH,IRHF)  017063 

ENO  IF  0 173  73 

C  SET  UP  X  ,  S  ,  ANO  U  FOR  OOTCQN  017  39.3. 

call  aSU<GCZ»GCY ,PHIC ,GCX , 3CY  ,3CZ*RKFSS»WM1,W.N2»wM3*WM4,Wm5»  0l7393_ 

_ 1  FM,eH.IHQLO,ICaH,WXX,WUU,HXU.PHIT>  _  _  _  _  017103 

C  GCZ  NOW  CONTAINS  X,  PHIC  CONTAINS  U.GCY'CONTAINS  3*  '  017110 

C  GCX  ,9CZ, 6CY,RXFSS  WERE  CUMHY  WORK  AREAS  IN  XSU  017120 

CALL  OOTCOM  CP  Hi  T.WXX  ,GCX,GC2«8TQ,FHIC,RKFSS«3CY,eCZ  ,GCY  »  WUU,  017137 

lGCSTR.IHOLO)  017140 

IFCl-OLC.eQ.IRFM>  GO  TO  35  017153 

_  __  ICH.IHOLOC _ _  _  _  _ 317160 

"00  33  I«I~IC3N  '  "  . .  017173 

00  3;  J*ICF,IRFM  Q1719J 

39  GCSTR( I, Jl *3.  317193 

35  CONTINUE  017200 

C3CY , 3CZ  ,GCY , PHIC, GCZ, GCX, RXFSS  APE  USEO  AS  DUMMY  «3»K  SPACE  In  OOTCON  017213 
W»ITEI<OUr,»> '00  YOU  WISH  rc  COMPUTE  the  kAlMAN  FILTER  GAIN  0~  PIC01722: 
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IK  IT  0IRS5T;.r  US  IN  ftr3-C«  SECTION,  l«-.  =  l  ENTER  J  C  TO  CONFUTE  E:i723; 
1NT£-  A  P  TO  PICK  IT  3IS£CTLT»  *  C 17 2«.  5 

S- 40  IKIn-,ii)mS r,z  517255 

IF  (MSG. .EO.'C'J THEN  C17263 

CALL  0<FTR<PHIT,3TD,GTD,OTO,GCX,RTD,HM,GCY,GCZ,»hIC,PKFSS,3Cr ,BCZ.:i727: 
lFM,GM,0M,3M,wri,WH2J  _  517263 

CGC  X  ,  SC  Y  «  GCZ  ,  3C  Z  *  3C  V  ARE  US-0  AS  OUMMY  *WGRK  SPACE  IN  CALL  TO  CKFTR  51729: 

_ _else_  _  _  ;i73c: 

CALL  PKDIRClGCX,>HIT*,GCYiGC'Z,WM,3TD,RKFSS,IC3M.IRFM,IRHMI  517311 

C  GCX,GCY ,GCZ  ARE,  OUMKY  WORKSPACES  IN  CALL  TO  PK0I5C  _  __  017323 

END  IF  017  330 

C •••*•**•***• INTME  FOllOWING_CAl  CUL ATIONS , _ 3CY ,GCY  , 8CZ  ARE  OUHMY  W OP  KSP6 17 34  1 

<!•*** **••**•  ACES  UNTIL  THEIR  LAST  USE  WHEN  THEY' ARE  SET  EQUAL  TO  THEIR*  F617355" 


C** **••** INAL  VALUES  FOR  PERFAL  SUBROUTINE 
Cl*1.0 

_  CALL  IONT  (IRFH, BCY, Cl* 

CALL  HATHRKFSS,HH,IRFH,IRHK,IRFH,GCYJ 

Cl*-1. J  _ 

CALL  MA301 <IRCK, ISFmTSC Y ,GCY « BCZ  «C 1 ) 

C  BCZ  *  I-RKFSStHH) 

WRITS  UOUT,»*  •  » 


017360 
017375 
017360 
817393 
017405 
"C17-.1': 
617  «»2C 
617435 


WRITE  IKOUT ,•  I  *00  YOU  WISH  TC  CALCULATE  THE  SAHf L* O-OATA  FILTEP  PG17445 


IOlES?  Y  OR  N>* 

_ REACI<IN,12*HSG _ 

IF  (MSG,£Q, *Y  *  >  THEN 

C  A<.  L  HAT  l(PHIT,3CZ,IRFH,IRFH,IfiFW,PHIC) 


Cl7»53 
317465 
017475 
S17  465 


WRITE (K0UT,*» 'THE  EIGENVALUES  THAT  CORRESPOND  TC  THE  SAHFLEO'O ATAC1749C 

1  FILTER  POLES  ARE . *  _  _ _  01750C 

CALL  HE*  GNIPHIC,  WV1  , WV  2  * iSF  M,  KH1 )  .  "'517510 

_  _  ENO  IF  017521 

call  HSCAlE (BCY ,GCSTR,ICBM, ]R  Fm,C1)  01753C 

C  8CY*-GCSTR  ICBH  X  IRFH  _  _  _  _  617545 

IF  <HSG2.EQ.*C*)  Then  C1755C 

C  FORMULATE  THE  OPTIMAL  CONTROL  LAW  FOR  PERFAL  517565 

CALL  HATl  (  BCY  ,  9C  Z  *  IC  BM  ,  IR  FM ,  I  -  c  ,  GCX )  017575 

C  GCX*  ~GCSTR<I«RKFSS»*’rt)>  1C3M _ X  _iFRl _ C17555 

CALL  MATH  BCY , RKF  SS  ,5  C8  M»~2RFM ,I~s  H W ,  GCZ)  “  *  517590 

C _ GCZ*  -GCSTRCRKFSS)  ICBH  X_  IRHH  _  _  C176G5 

IFLGCZ*3  *  '  C17610 

_ call  HATl(BT0»8CV» IRFh,ICSM»IRFM»GCSTR)  517621 

Cl*1.0  C1763C 

CALL  HAOOl  CIRFM,  IRFH,PHIT  , GCSTR  , 9CY  ,C1) _ 017646 

C  BCY*  PHIT-STO(GCTR)  IRFN  X  IRFh  017650* 

_ WRITE CKOUT,*) •  *  017661 

WRI fS<«OUT,*> *00  YOU  WISH  TC  CALCULATE  THE  POLES  of  the  CPTIWAL01767G 
1  LO  SAHPLEO-OATA  CONTROLLER?  t  OR  N>  *  01766: 

* EACIKIN, 121 MSG  51769; 

_ IF_WSG.£Q.*Y*)  THEN  _  517731 

WRITE CKOUT,*J »TME  EIGENVALUES  THAT  C3RFESP0N0  Tl  THE*  POLES  OF  THC1771C 

_ 1£_ OPTIMAL  LO  CONTROLLER  ARE . *  317725 

CALL  HEIGN  CBCT,*.Vl,WY2;iSFM,FHIC>  "  **'  517*35 

_ EN0_  IF  _  _ _ _  _ 0177  4? 

CA.L  HATH  BCY , BCZ ,1s FH,IRFM,I®FH,PHIC)  *  017*53 

C  PHIC  «IPHIT-STO<GCSTfilMI-RKFSS»HHj)  IRFh  X  IPFm  017765 

CALL  HATH  BCY  *R<FS$,IF.FN,  IRFM , IRHk, 6CZ)  01777C 

C  8CZ*(PHIT-«T0«6CSTR»)RKFSS  IRFH  X  IRHK  C17765 

ElSE  517790 


CALL  HATH  BCY  *RKFSS  » IRFH,  XRFM , IRHk, oCZ)  01777C 

BCZ*(PHIT-6TO«GCSTR»)RKFSS  IRFH  X  IRHK  C17765 

ElSE  517790 

FORMULATE  THE  SUBOPTIHAL  CONTROL  LAW  UST»*-GCSTR CX  AT  TSU8  I  MINUS*  51763; 
CALL  EQUATE  (GCX,  BCY  ,  ICBH,  IRFM  017616 

GCX»-GCSTR  IC3H  X  IRFH _  5 17  62 i 

CALL  HATl (PHI T, BCZ, IRFH, IRFM, IRFH, GCSTR)  '  *517*30 

Cl*l,0  _  01764  3 

CALL  HATH8TO,GCX, IRFH, ICBH, IRF«»eCY*  C1765C 

WRI TE  fKCUT,* )  *  «  _  _  _  _  017*65 

WRITE  IK0UT,*>*00*  YOU  WISH_TC  CALCULATE  THE  POLES  OF  THE  OPTI**A5l7*7: 
1L  LC  SA**PLEO  DATA  CONTROLLER?  Y  OR  N»*  0l7*e: 
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C  RTO  is  Th:  DISC  9ETE  T2m£  iPps.CX  C?  ;T 
Cl* 1  •  • 

CALL  iosT(I<»FT,GTO,Cl)  Cl*?7£ 

C  GTO«GTO  *  I  £16561 

RETURN  cie=9: 

£no  jiesa: 

*  deck  okft*  '  -  ....  tieeia 

_  SU3RCUTINE  0KFTR|eHlM,8M0.GMQ,0MD,Wiil,.RMD,MM,w:i3,kM5,Mne.,eKFSS,  Ciet20 
1  F2,H2,Fm,Gm,Qn,8m,WmZ,wk-)  '  01863* 

0166^0 

this  ROUTINE  CALCULATE  THE  STEAOv  STATE  KALMAN  FILTER  CAIN  MATRIX01865: 


•  lorr  j 


__FOR_A  SANJPLEO  ATA  CONTROLLER  _ 

REAL  PMlMC  N0XM«N0IH) « 3M0~(  NOIM  *NOIk)  «GhO  (NOI M*  HOI  M)  » 
1  GNOCNDIM, NOIM) ,HM1 (NOIM, NOIM) ,RM0(N0IM,NCINI  , 

1  HMO®  IM,NOIM),  MM3 INOIM,  NOIM )  ,  MM5  (NOIM,  NOlM»  , 
1_WN6JN0IM«  NOIM)  «  RKFSS  (NCIM,  NOI  Ml_»F2INOIf,  NOIM) 

*1  «H2 (NOIM*  NOIM) *FM ( KOI N«  NOI Ft « 

1  GH4 MDI M, NOIM), CM  IN CIM, NOIM), 0M(NDIM« NOIM), 

1  MM'2  CN0IM,N0IMI  ,MMiT(N5iM,NOlF) 


REAL  COMlt  1)  ,  COM2  (1) 

"COMMON  /MAIN1/MO:M,NOZM1,CCM1 

commcn  /inou/  <in,kout,kp u ncm_ 
commcn  /rntim/  rntine.oe'ltim 

COHHCN/MAIN-»/NOIm2  ,  NQI  M3 
COMMCN/MAUNS/MSS 
COMMCN  /NAIN2/  COM2 


£1666: 
C1867; 
C1S66: 
C1669: 
016703 
C1871C 
01672? 
01673:' 
018 ’LC 
C1S75C 
01676G 
C16770 
018761 
016790" 
ciescc 
016610 
018*25 


common  /ka:n6/icet,ic8m,icfa,:c6a,ic6m,:cgt,:c3a,irfa,irfm,i®ct,  ciess: 

1  IBHT, IRQA«IO, LOG, IRHH, NUMOTS _ _ 0166LC 

CHARACTER  MSGi*l,MSG*6d  019650 

DELETE  DETERMINISTIC  STATES  _AS  IN  TM£  CONTINUOUS  TIME  CASE  016860 

mRITETKOUT,*) *IF  YOU  PLAN  TC  USE  the  DOYLE  ANO  STEIN  TECHNIQUE  FORC16970 
1  THIS  RUN  YOU  MAY  WISH  TO  HCOIFY  THE  VALUE  of  NUNGTS,  THE  NUM3ER  OC18860 
IF  OETERMINISTIC  STATES,  OO  YOU  WANT  TO  CHANGE  NUMOTS?  Y  OR  N* *016*93 

__  REAP  (KIN.1DMSG1 _ C1690C 

NUNSAV-NUMOTS  016913 

IF  (HSGl«EQ«*V* )  THEN _  018923 

MRITETKOUT,*) 'ENTER  THE  NEM  VALUE  OF  NUMOTS  FOR- THIS  RUN*'*  018930 

RE  AO  (KIN,*)  NUMOTS _ C169<.C 


END  IF 

_ HRITE<KOUT,»»  « NUMOTS*  «, NUMOTS _ 

IOS- NUMOTS* 1 

_IRF2«IRFN-NUMOTS  _  _ 

IF  (  NIP13TS,  EO,  0)  THEN 

C  _ ST ORE  SYSTEM  MODEL  IN  INTERMEDIATE  MATRICES  COMPATIEELE 
C  WITH  THOSE  BELOW.  WHEN  THER  ARE  DETERMINISTIC  STATES  REMOVEO 

CALL  £qUAT£(F2,PHlM,IRF2,IRFZ)  _  _ 

CALL  EQUAT£(W*Ml,GMO,'leF2,  IRF2) 

_  CALL  EQUATE (H2, MM, IRHM,IRF2) 

CALL  EQ»JATE(WM5,8M0,IRF2,ICSM)  ' 

_ CALL  £0UATE(WM2»0*D,IRF2»2RFZ ) 

ELSE" 

C  DELETE  THE  DETERMINISTIC  STATES  FCRM  THE  MODEL  USED  TC  FORM 
C  THE  STEADY  STATE  KALMAN  FILTER  GAIN  MATRIX 
OC  2112  x*:os,irfm 


II «„ -NUMOTS 
00  2112  J»IDS,IRFM 
jj* j-numots 

2112  _NM*(II,JJ)«FMCI,J) 

00  2113  I«i,IRMM 

oo  2113  j>:os,:rfm 

J4« J-NUMOTS 

2113  M2  (I,JJ)BHMJI  ,JI  _ 

C  FORM  020  620  NOW 

00  2115  I*IOS,I®Fm 


018950 

01896: 

51897: 

01896S 

01899: 

C19I0C 

C193i: 

J19c2i 
019033 
019oh0 
C19*5C 
C 19063 
019370 
C1936C 
019390 
019103 
01911C 
019123 
01913C 
019 INC 
C1915C 
01916: 
019170 
01916C 
01919C 
319200 


ii«:-nu-ots 

o:  2nr  j*i.:c3->  ci?22: 

2115  WM3UI,J)*8MI,J»  C1323; 

oo  211-  i*ns,isFf-  :i52<*: 

II*I“NUM0TS  1 15250 

PC  2114  4*1,1 SSl't  _ _  _  _  C  15265 

1ii4  HMr(n,j>«s-d,j)  ”  '  "  . .  ci92ra 

11  FORMAT ( 411  _  _  :i5280 

NSAV*N0IM2  C1929S 

N0lN2*N0lH  C193CC 

CALL  HVInTG(F2,WM2,wM5,WM6,wI'1.QM,WM4,WM3,1RF2,ICGH,:CBN,ICGMI  C1931C 

_ N0IM2*NSAV _ _  __  _  819325 

£1*1.0  “  ~  -  819330 

_ CALL  I0NT<I®F2,WN1,C1I_  01934C 

END  IF  019350 

C  CALCULATE  G10  (OlO)  GMOT  _  019360 

CALL  HAT3(IRF2,IRF2,WH1,WM2, RKFSS)  C19372 

CRKFSS  IS  CUMMY  WORK  SPACE  AT  THIS  POINT  IN  THE  PROGRAM  C19380 

WR'ITEIKOUT**)  *  00  YOU  WISH  'TC  HCDfFr  THE"  CMO  MATRIX  BY  THE  DOYLE  819395 
1  AND  STEIN  TECHNIOUf  FOR  CONTINUOUS  THE  CONTROLLERS  EXTENDED  TO  019-05 
1  THE  OISCRETE  TIME  SYSTEMS, '  Y  OP  N* *  G19411 

READ (KIN»11)MSG1 _  319420 

IF  (MSG  J.£<J»*Y •)  THEN  ■"  "  019-35 

CALL  DAS2(3MI20S,IDS>,RKFSS,WHl,IC3M,wM3,IRF2,HMfc>  01944- 

C  RETURNS  A  m'OOIFIEO  OHO  VALUE  TC_e=“USED  In  FINDING ‘fiKFSS  019-57 

END  IF  _  519-65 

C"  CALCULATE  THE  KALHAN  FI. TER  GITnS,  i<"kF§SVFCR  ESTHER  THE  MOOIFIED  C1947C 

C  _Q10  OR  THE  UNMODIFIED  OlO  819488 

C  'OHO  IS  STOREO  IN  RKFSS  019-92 

_ CALL  TRANS2 (IRHK,IRF2,H2, WH3) _ C195C0 

00  Til  I-lVlRMH  :i95l11 

1C1  _MH4(I.l)*RNO(I,:)  __  91952; 

CALL  kFLt«rrRF2,IRHM,F2,WM371fK?SS,WM4,WM6,WMi,WM5)  ~  "  0l9f3_£| 

C  WrtoaPrtSStHMS  CLOSED  LOOP  MEA^  MATRIX _  _  _  519545 

C  WH1  *  RKFSS  WITHOUT  Th£  ZEROS  F'Cr  THE  OLTERhI' NISTI S  STATES  3I9S5C 

C  NOW  AOO  THE  ZEROS  FCR  THOSE  STATES  C19562 

I?  ( NUM0T5 • EO • 0 1  THEN  319570 

00  2029  1*1,IRFH  019585 

00  25294*1, IftMM  “  . *  C19590 

2029  RKFSS(I,J)«MH1(I,J)  519605 

ELSE' . .  '  019610 

OG  2119  4*1,IRMH  019625 

0O~2 1181*1,  n(ThOTS  '  819630 

2118  RKFSS(I,4>»0  019649 

00  2119  I* IOS, IRFK  "  019655 

II  *  I -NUMOTS  01966C 

2119  RKFSSn,J)*WHlli:V4)  019675 

ENO  IF  519685 


C  NOW  WRITE  OUT  THE  RKFSS  MATRIX  019690 

27 _  10*5  _  019700 

HSi* *STE"AOY  STATE  SAMP.SO  OATA  KALHAN  FILTER  GAIN  MATRIX*  019713 

_ CALL  WHAT IOCRKFSS, IRFH,IRHH,IC, KIN, K0UT,N0IH,KSIH)  _  019725 

NUNO TS*NUHSAV  '  ~  '  019T30 

RETURN  019740 

ENO  *  .  —  Cl9'f5T 

•  OECK  OAS2  019760 

SUBROUTINE  0AS2 (8H,QM0, V»ICEM*MM3*IRFM,NM1)  519773 

_  REAL  BH (NOI K, NOIM) ,010 ( NOIM.NOIMI ,  V (NOIM,NOlH) ,  819780 

T  WN3(N0IH,H0IH),  WHKNOIH.NOIH)  019795 

C  THIS  ROUTINE  ALLOWS  CHO  TO  BE  MOOIFIEO  IN  A  MANNER  SIMILAR  TO  THE  00019*00 
C  YLE~AN(5TT£IN  T ECHN lOUE- P’Off- C £ N TINUCUS  TIME  SYSTEMS.  519912 

C  QHOHOO*CMO  ♦ (SQ*SQ )(6M(V)BMT) "SAMPLE  TIME  019620 

C  WHERE  SC  IS  A  SCALAR  OSSIGN  PARPmETER  AMO  VISA  POSITIVE  DEFINITE  519532 
C  SYMMETRIC  MATRIX  OSSIGN  PARA m£T6s  .  AS  SQ  — ->TC  INFINITY  IN  THE  CP619640 
C  NTINUOUS  TIME  CASE,  ROBUSTNESS  PROPERTIES  OF  A  FULL  STATE  FSE03ACK  819655 
C  CONTROLLER  APS  RECOVERED.  T-IS  SCUTINE  IS  eiSEO  CN  E.  LLOYDS  MAST£RS019!63 


thesis  ,04t.  i*ir 

CHARACTER  MSG»6J 
REAL  C3MI  (II, COM2 (11 
CO '("ON  /Mi  INI  /NO  :  >*.  NQIMi ,  CCHl 
COMMC:*  /RnTI.M/RNTIME.OElTIM 
CO.NKCM  /MAUN5/HSG 
* COMlCM  /.MAIS2/  C0^2 


11 


319 470 
319433 
S 193  93 
319901) 
319913 
319920 
014933 
319943 
319953 
319963 


CCNMCN  /INQU/KIN,  KCUT, K PUNCH 
HRITSUOUT,U>»  * 

FORMAT  (Alt 

WRIT£<KOUT,*> ‘THIS  ROUTINE  J-COIFIES  Th£  VALUE  CF  QMO  USEO  TO  CALCU019973 
l  LATE  THE  STEADY  STATE  KAL.mAN  FILTER  GAIN.  THE  MODIFICATION  PSRFCR319983 
IMEQ  IS  SIMILAR  TO  THE  OOTLE  AnO  STEIN  TECHNIQUE  FCR  CONTI NUCUS-tt MO  19990 
IE  SYSTEMS.  FOR  A  COMPLETE  DESCRIPTION  SEE  E.  LLCYOS  MASTERS  THESI320J03 
IS.  AFIT,  031.  BRIEFLY  THE  nCOIFICA TION  ATTEMPTS  TO  ENHANCE  RC3UST323313 
1NESS  OF  THE  LOG_  CONTROLLER  AKO  IS  QNOO»G.MOtQ.MO»GNOT«‘SQ*SQ*OELTI(‘020020 
1  *t9M<V>9.NT)>  ...  THE  LARGES  The  VALUE  CHOSEN  "OR  THE  SCALAR  SO  TnC23J3Q 
IE  MOPE  ROBUSTNESS  RECOVERY  (COMPARED  TO  FULLST4TE  PE  SO- a  A  CO,  V  M323J40 
lUST  eE  A  POSIT Z/t  OEF.  MATRiXl  CHOCSING  /«!  AQOS  PScUOONOISE  SQUA323)51 

323C60 


4  POSITIVE  OEF.  MATRIX. 

ILLY  TO  ALL  C0NTRSL_XNPUTS_.  * _ _ 

WRITS <<OUT » 11)  * 

WFITEiKOUT,*)  *  ENTER  1—  TO  INPUT  SQ»  2—  TO  INPUT  V.  3—  TC 

1  CONFUTE  MODIFIED  0,  4—  TO  EXIT  ROUTINE . NOTE  l  ,2  -IJST  3E 

1_ACCCNPLISH£0  3EFCRE  I,  AJNC  3  3EF0RE  A.  3UX  THAT  1,2,3.  CAN  Be 
i  DONE  ANY 'NUN 3ER  CF  TI'mES  BEFORE  USING  4* 

WRITE <KOUT.ll> •  * 

WF-ITSCKOUT,*)  *S.NTSR~uPT ION*  * 

_  RSADOtlN.O  IOPT  _ _ _ 

GO  TC  <  1.2. 3.4) ICPT 

WSITe<KOUT .11) •  *  _  _ 


WRIT£<«OUT,») 'ENTER  SO*  * 

«£40  (KIN,  •)  SQ _ _ _ 

GO  TC  5 

W«ITE<KOUT,  U>  •  « 

WRITE (KOUT ,*)  *V  IS  INITIALIZED  TO  THE  IOE.nTITY  MAT3 IX  UPON  ENTRY  TQ20213 
l_0  THIS  OPT  I  IN.  IF  rau  DESIRE  TO  CHANGE  V  .  ..RENEM3ER  IT  MUST  3E  320225 


320373 
0  20  38  2 
320393 
023135 
020110 
3  23125 
3  20 133 
023149 
323153 
Q23162 
3  2317C 
023130 
0  20190 
325233 


1  POSITIVE  DEFINITE . ENTER  THE  I/O  OPTION  (I/O  OPTIONS  ARE 

.1  PRINTED  AT  THE  BSGt N.nI.NG  OF  THE  PROGRAM)  ELSE  ENTER  A  ;  >♦ 

Cl*1.3 

_CALL  IONT  I ICSM*  V.C1J _ _ _ _ 

REAO (KIN,*) 10 

IF  (  10. EO.  0)  THEN _ _ 


GO  TO  5 

ELSE  _ 

MSG*  *T H£  CHOSEN  V  MATRIX  IS* 

CALL  MMAT 13 (V ,ICBN, IC5M, 13, KIN, KOUT, NOIM.NOIM) 
ENO  IF 

GO  TO  5 _ _ _  __ 

V 


3  WRITE<KOUT,U)  » 

CALL  .MAT4CV,a.M,IC2.M,IC8.M,IRFH,WM3> 

CALL  NAT1(B.M,HM3,IRFM,IC3M,IRFM,WM1) 

_ Cl*SC»Sa»OELTI.M  _ 

CALL  M4001 ( IR PM, IS  FH , OHO , -M 1 ,WM3 ,C l > 

_ 10*5  _ _ _ _ _ 

MSC*».M(30:*IE0  Q  MATRIX,  Q»OC** 

CALL  MNATI0(WM3,ISF.M,IRFN,IC,KIN,K0UT,N0£P,N0IM> 

GO  TC  3 

*  CALL  EQUATSCOho,WM3  ,ISFP,IRFmi 

C  REPLACE  THE  VA„'JE  IN  Q(*0  WITH  QHOO 
_ RETURN _ _ _ 

ENO 

•  OECK  OOTCON 

SUBROUTINE  OOTCON (PMIm,WXX, *,(•!, X  »5mO.U,Wn2,9NI?Rn, 
1  XPRIM.S.WUU.GCSTS.rHOLQ) 

real  somki), coi-Edi,  pmimxc:i*,n0I»>, 

l*A<  (NJiM.NOIM)  ,^M1(^DI%n0IM  ,X  (NOIM.  IOI^)  , 


323230 

020 240 

0  20250  " 

329260 

020270 

02Q280_ 

023293 

020300 

323313 

3  23  323 

020  333 

320  J4Q 

3  23  353 

020  360 

020370 

5  23  T33 

020393 

C2C403_ 

023*13 

0  20  423 

020*33 

320440 

023450 

323463 

320470 

3 23 *60 

0  2C49TI 

020533J" 

•3  22513 

025=23 
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►V 


*  -  * 

‘N  -V,S* 


I.  , 


O; 


.*> 


s 

s' 

s 

s’ 

s' 


<3 


i  sido.oif, noimj  ♦  ujnd:k,noim  .w'i2ir.a:«fnD:>i»,  32:53; 

i  ph;p- "hnd:^* ns. m>  ,>p- i k< noi^.no; ►*)  ,s *noi>’. kd:>'>  «  :2C3«.: 

1  «UUIN9lM,fOlM),GCST?<NOlM,N3:M>  C2.-55: 

CHARACTER  MSG*65  C2Cs6« 

CC MrCN  /MAiNl/NOlM, NOIMI.CCKI  C2C57. 

_ COMMON  /MA1N2/  COM2  _  _  _  _  C2:  =  s: 

COMMON  /MAIKU/NOIH2  ,N0i*i3  "  "  '  C2;r93, 

_  COMHCN  /INOU/KIN,  KOUT»KPUnCH  _  120=00 

COMFCN  /RMIH/  RNTIM£,D£LTIF  023610 

COMMON  /MA:N6/IC3T,:«M.ICFA,:cGA,ICGM,:CGT,ICQA,IRFA.I*FN,IPFT,  C20620 
1  XRHT, IRQA ,10 ,LQG« IRHM, NUFOTS  020632 

COMMON  /MAUN5/MSG  020645 

C  THIS  SUBROUTINE  COMPUTES  THE'STsSDY  STATE  CPTXFAL  FEEDBACK  GAIN  MATRIC2C650" 

CX _ GCSTR ,  BASED  ON  A  .INEAR  QUACKATIC  COST JJRITERICN,  FOP.  A  SAMPLED  C23  66G 

C  OATA  CONTROLLER  ~  "  C20670 

C_SEE  MAYSECK  chap  14  fop  a  DETAHEO  OXSCUSSXON  CF  ALGORITHM  AND  020660 

C  EQUATIONS  C2G69G 

2C  7  0  0 
C2C 


C 

C 


MT«1 

""TRANSFORM  SYSTSM”SO  KLEImHAN  "RICCATI  SOLrfSR  MILL  HAnOLE“'S— N0t«0_ 
CALL  PRlMlT<WM2.U,IC8M»GCSTn ,S»I MOL O.BMO.NMl, PMIPRM.X.X PRIM. 
1  PMIF) 


C  NM2»UI*ST 

CNOw  compute  kppim  FROM  RICCATI  ECUATICN 

CALL  MAT3(IM0L0.IC9M,8M0,GCSTt,wmi>  “ 

CALL  ORIC(IHOLO«PPXPRM;MMl,XFPIM.XtGCSTR> 
C  GCSTR  CONTAINS  INFO"  THAT  IS  NOf  "  USED 

C  X  CONTAINS  **KPRI M**  IRFM  X  IRPH _ 

T  NON  COMPUTE  GdST3.PR.lM 


ij 
0  20  720 
C2C732 
G2C74jj}- 
020753 
J20  763 
020773 
C2C76: 


Ct*1.0 

“CALL  HAT3ATICBM,IFOLO,BmO,X  .GCSTR) 
call  HAOOKICBM,  ICBM.U,  GCSTR  ,NM1,C1) 

Tall  gfInv (ic3m, icbf  *hmi .gcstr  *  hr ,  mt>  ~ 

IF  CMR.NE.ICBM)  then 

PfclNT  *, ‘INVERSE  CF  U  IN  O'OtcCN  NOT  0?Tu L L  RANK ,  ~  RANK  IS  *, 


TncTip 

CALL  NATi»(GCSTR,8F0,IC8M, ICBF  .XHCLO.WML) 


CALL"  HATl(MMA.X*ICBKtiH3L0tlMCL0t GCSTR) 

CALL  MATK GCSTR, PMIPRM«ICaF«IHOLO>XHCLDtMMl) 

C  MMl«6cSTRPRtM»  t  (U^BHOt  CKPr.lMi  BhC)  I)  I9n1T(KPRXNIPHIPRN) 

C  ICBM  X  IRFM 

Call  MA0DlTlC6M,THbLBV^Mi,'MM2t GCSTR, Cl) 

C  GCSTR  IC3H  X  IC9f 

IO  «5  ""  "  . . . 

MSG«»TH5  OPTIMAL  STEAOV  STATE  FEEDBACK  GAIN  MATRIX, GCSTR* 

Call  nmat io i gcs tr , iCbmTI hold , io , k"i N',kou"f ,‘noif ,  noi  f> 

_  RETURN 


ENO 

*_  OECK  PKO  IRC  _ 

SUBROUTINE  "PKOIRC  <NiPHlM,NMi,MM2,MM,eMO,RKFSS,IC8F,iRFM,IRHM) 

_ REAL  COM3,  m, COM2  U)  , UNO  IH,NQXH),  _ _ 

1  PHI  F  <  NO  I M  ,  N  01M>  ,  HFI(NOiM,NClF» ,  NF2< NO  I M , NO I “ ) , 

_  1  HM(N0IF,N0IM),  BMO (NOI M»  NO  IF ) ,  RKFSS INOXH, NOIM) 

CHARACTER  MSG*63 , FSGl*l 

CO MM CM  /M A INI /NOIM, NOI Ml, COM! 

COMMON  /MAI N2/50M2 
COMFCN  /MAUN5/  MSG 

COMMCN  /INOU/  KIN,  KOUt , K PUnC F  . 

C  AS  _IN  MAYBECK,  SECTION  14.5,  RKFSS»PHI  Ml  C3MO)N  *SC.  SO  IS  A 
C  SCAlA-ToESIGN  PARAMETER  AND  N  IS  ANY  NONSIMGULA5  M  X  M  MATRIX. 

C  MAYBECK  SUGGESTS  THAT  W»  f MM < PM IF  I) BMO) I  IS  A  POSSIBLE  CHOICE. 

C  THE  PKFSS  PICKED  AS  A  RESULT  OF  THIS  ALGORITHM  FCRFS  THE  BASIS 
C  OF  A  SUBCPTIr.AL  COMTP.l  LA*  , US TAR» GCSTR (»(TI~HlNUS) 


62579TT  1 

9209  Ojj“"  A 
02C913 

_ 02C82C 

022 “33 
6  20  643 

023653“  A,C 

020 96C 
026670 
02C  663 
0  2C  9  93 
32C90: 

926910 

_  020  92T1 

620 93 Of—  A 
0  209U0I 
C2:95C 
020965 
020  971J-  A 
02i)933 
0  20  993 
021303 
C2i:iU— A 

_ 0  21C23 

021330 

021343 

021358 

02126: 

021373 

32138: 

C 21393 
021100 
021115 
021120 
021133 
02ii**: 

021155 
021160 
C  21 17  (• 

521162 
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WSITSIOUT.IC)  *  *  021190 

IT£<<2J7,*)  ‘This  ROUTINE  QUCU-ATES  T“E  ST£Ov  STATE  KALMAN  FIlT;li25; 

it?,  gain  o:»ect».y<  tmat  is  with  cut  use:  =  mss  from  the  mats.:*  r:ccatc2i2i: 

II  EQUATION  AS  THE  BASIS  Ce  <FSS)I  EQUATION  AS  IN  SECTION  iw.S  .NAYG21220- 
13ECK  •  KFSSsSQMPHImDBmO  <W)  WHERE  T-»£  SCALAR  SQ  AND  THE  MATRIX  02l23w 
1  j*  ARE  DESIGN  PASAMETERS...THE  LARGES  THE  SQ  TH£  MORE  ROBUSTNESS  021240 
1  THE  SUBSEQUENT  CONTROLLER  WILL  **A,£.  NOTE  THERE  ARE  NO  STA31LXT22125 1 
I Y  CLAIMS  FOR  THE  RESULTING  CONTROLLER.  SC  BE  SU*E  TO  CHECK  THE  £1021261 
1GENWALUES  OF  THE  SUBSEQUENT  CONTROLLER.*  "  021273 

NRITETKOUT .12) *  *  G2126v 

12  F0RN4T ( Al/I  C 21290 

_  WRITE<KOUT,*>*TM£  OPTIONS  Fes  THIS  ROUTINE  ARE  1*>CHC0SE  SO.  2-*  C0213C0 

1HCOSE  H.  3-.  COMMUTE  ANO  PRINT  RKFSS,  "«->  EXIT  ROUTINE . *  C21310 

5  __  WRITE  (KOUT, 12)  *  »  _  C2132C 

WRITEIKOUT,*) 'ENTER  OPTION**  ---  -  02133X 

REAO  (KIN. * ) IQPT  021340 

GO  TC  <1*2. 3.0  IOPT  021350 

GO  TC  w  C 21363 

1  WRiT£<~KOUT,  12)  *  *  "C21375 

HRITECKOUJ,*)  'ENTER  A_  VALUE  FOR  SO.  LARGER  SQ  GIVE  BETTER  RCBUSTNEC2138C 

"1SS>*  "  "  C2139C 

REAO  <KIN.* ) SO  _  _  C21-30 

GO  TC  5  .  021410 

2  WRITE  IKOUT, 12) *  *  021 420 

WRI TEIKOUTi*)  *00  YOU  WANT  TC"  PICK  W  ARBTRARILy"  OR  DO  YOU  WANT  W  T0021435 

_  1_B£  HH(PHIMX)3H0  —INVERSE  AS  IN  MAtBECK  SECTION  14.5.  NOTE  THAT  021440 

1  IRHM  hUST  BE  ECUAL  to  XCBM  SINCE  W  must  BE  IC3M  X  IC3M  •  ENTE'-  021450-' 

_  IAN  A  F0RAR9ITRASY, _ M  _OTW£RWISE>^  _  021460 

"READ  <KIN,  1DHSG1  "  ~  . .  021-70 

11  FCRFAT(Al)  _  C  21400 

IF<HSG1.EQ.*A*)TMEN  "  *  C21U9C 

_  WRITS<K3UT,*) ‘ENTER  I/O  CPTICN  FOR  h(SEE  INPUT  ROUTINE  FOP  EX  PL ANA  0215 CO 
1TION  OF  INPUT  OPTIONS  1 . 2, 3 .4,5 ,6) > *  02151C 

_  REAOCKIN,*)IO  _ _ _  __  _  C21520 

HSG* 'AR3ITRA9Y  W  MATRIX*  ~  "  "  "  *  021*30 

_ CALC  HNAjT  10  (W  .ICBM.IC3M  .IC.KIN.KOUT .nCIM.NOIM)  0215*0- 

ELSE  "  22155  0- 

C  COMPUTE  M  A S_0 ESCRIBED  ABOVE _ _ _ 021560 

IF  riCBH.NE.IRHM)  THEN  "  C21S7C 

_ MRITEIKOUT,*) ‘NOTE  THAT  IRHM  MUST  EQUAL  ICBH  TO  USE  THIS  METHOO  CF0215BO 


1  CALCULATING  M,  ICBM* * , ICBM. *  IRHM*  *  .IRHM 

GO  TC  5 _ 

END  IF 

CALL  EQUATE  IWMltPHlM.IRFH.IRFM)  _ 

GHINV  DESTROYS  THE  CALLING  ARRAY 
MT*1 

CALL  GMlNV  < IRFH, ISFM, WM1  ,~WH2  .  MR.  NT) 

_ CALLJlATliHM.HMa.IRHM.IRFjSlBFMjjWMl)  _  _ 

CALL  iATl  <HM1 ,3M0  »IRH.-'.,  IRFM.ICBM.MMiT) 

CALL  GHINV <IRHM.ICaH, WMg.H. MR .MT) 

"ENO  IF 
GO  TC  5 

WRITE  <KOUT. 12)  *  * 

CALCULATE  RKFSS 

CALL' EQUATE  <WMi «  PWIH. IRFM, IFFH) 

GHINV  OESTROYS  CALLING  ARRAY 
NT*1 

CALL  GHINV CFFH. IRFH, WN1, WM2.HR, NT) 

CALL  NATl < WH2.3.MD.  IRFM, IRFM.ICBM.WM1) 

_  CALL  HATl<WMl,W,IRFM,IC3H.ICtM,WN2) 

CALL  NSCAlE<RKFSS»"wm2,IRFm,IRMM,SC) 

10*5 

NSG**RKFSS,  PICKED  DIRECTLY  IS* 

CALL  MHAT  IO<RKFS§.jJRFHj_JRmm,I  C.KIN.K0UTjJ<0I  M.nOIM) 
GO  TC  5 

_ RETURN _ _ 


0  21590 
C21630 
021610 
021623 
021630 
021640 
C 21650 
C 21660 
02167C 
C21663 
021691 
021700 
021713 
021723 
021730 
C2174C- 
021750 
021763 
021773 
021760 
021790 
521 50  3 
021813 
02152. 
52163C 
021645 


'  *  •  *  *,•  \*  V  /  V*  .vo  .%  .n  s\  j 


so 

•  OSC<  fricIT 

SUa^CUTlNi  "RImIT IWM2,U,IC3M,GCSTR,S.I9Fm,3HO  .HMI  ,PH  ie>R  M,  X.xPRlv, 
1  P  HI  M 

C  THIS  SUBROUTINE  COMPUTES  TH £  =RJMED  QUANTITIES  “SEOSO  «HEn  USING 

C _ KIEINMAn  RICCaTX  SOLVER  with  kcn  ZEFQ  CROSS  COST  WEIGHTING 

C  MATRIX  HXU 

REAL  WM2(N0IM,N0IpI,GCSTS <NCIM, KOI  HI ,S(N0IM ,NDIM> , 
iaPO(NOlM,HOlMI  .MMKNOlM.NCIM  »flHI9RH(N3lN, NOIMI  « 

1  X ( NCI H »  NO I  Ml *X  (RlH(N3lH,N0iM ,PHIM (NOIM.NOI *1 
REAL  COM1 (ll,CON2  lit 

_ COMMON  /HAIN1/  XQlH,NRIHl,GChl _ _ 

COMMON  /HAIL2/COH2 

_CCH*'C,I  /IXOU/KIN,KOUT,K«ONCH _  _ 

C  MOM  COMPUTE  XPRIP,  PMIP-M 

_  CALL  EQUATE (WM2«U, ICBM, IC3M)  _ 

C  GHINV  OESTRIVS  THE  CALLING  ARRAY 
NT*1 

CAwL  GM  INV  ("IC9M  »I CBM, WM 2,  5CSTe  ,MR»MTI  . . * 

C  GCSTRs  ui  IC3M  X  IC9M 

* 'CALL* HAT ^ (GCSTR^S«ICBM«ICSH,]RFK,WM2I 
Cmm2«  UICSTI  IC3M  X  IRPm 

CA_t  MATl (8M0  «HH2  » IRFMi IC9M»IFFK»  4M1 1 

_ Cl»-1. J _ _ 

CALL  MAOOl  I  IRPM*  IRFm#FHIM»WM,PHIPRM*C1) 

C  PHIPPn*  PHlN-aHOCUDST  IR PH X  __IRPM _ 

CALw  MAti'lS.HM2,IRPM,2CaMfI«PM,MMil 
CALL  MAOOl (IRFM, I»Fm,X, WM1 , XPFI P ,C1 I 
C  >PRIr«  X-S (UIIST  IRFM  X  ~  IPFp . 

C _ _  _____  _ 

RETURN 

END 

•  DECK  PGS  * 

SUBROUTINE  RGS  CGCSTR.RKFSS  *GCX»GCY  , GCZ«BCY.BCZ,FC»YO, 
i  WMi,WM2,HM3.HM4tWM5,WHa,WM/,NM8,WM9»WN16.WVl ,WV2, 

_ 1  MNA  ,WN3, WMC, WNQ,  l»M£,HMF«  FT  ,ET,6T,HT,QT«PT, 

1  FM,6M,GH,MN,QN,»M,'x0,F0,MX*,WUU*4XU,FA,BA,GA,CA,GUA, 

_ IMA  A  ,  FX  A  ,  R  A  ,  Px  V  A  ,GCZA,IP.r,  I FLGC Z  ,  IFL GSO  , 

inu.pumax.pum;n,Px'tmax,pxtmik,kumax'.mumin,kxamax,hxamin, 

1  PUOUT  ,PXTOUT,HXTOUT.  MUQUT,  4V  3,  W7*») 

■  REAL  coil  lit. CCM'2'at 

c  _ _ _  ___ 

i  ThIs~ SUEIOUTINE  SETS  U<*  i  CONttKUffUS*  OISCRETI ZED  CONTINUOUS' 0-  A  * 
C  SAMPLED  OATA  LOG  CONTROLLER  BASED  CN  USERS  REQUEST.  EACH 
C  CONTROLLER  IS  PUT  INTO  THE  R«CPER  FORMAT  FOR  TM£  PERFORMANCE 

c  analysis  subroutine,  psrfal. _ _ 

CHARACTER  MSG*6C 

Seal  ft  (Nox~K,K02Yi7BTiNoT^?iM,GT(Ko:K,NoiMi% 

__  1  HT  (NOIM, NOIMI ,RK  (NOlH,hOIM),FH(NOlM, NOIMI, 

IBM ( NCI H« NOIMI ,GM  (NOlM.NCIrt ,XC(N0IM» t 
1MMINCI M.NOIM) «  OH  CNDIM.NOIM .PC(N0IM,N0IH»  , 

1QT I  NCI M. NOIMI , RT  (NOIM, NOIMI, 

IGCSTMNOIP, NOIMI,  R«FSS(M)lH,XCIN>, 

IN VI  (NOIMI  ,HV2(N0IMI, MXUINOIP, NOIMI,' . 

_  1MM1  CNOiM, NOIMI ,4M2  CNOl M. NCIMI « KM3 (NOIM ,N0 IH> . 

1MM-  INOH.NOIM  I,  WMf  (NOIM,  NCIMI  .WMolNOlM,  NOIMI  , 

1MM7  (NOIM, NOIMI ,NMP  (NOIM, NOIMI ,NH9(N0IK, NOIMI * 

-  IMHlii  (  NOIM,  NO  I  Ml  ,HMA(NOlM2,NOlM2),Mil3(NOIP2,NOlM2lf 
1WMC(N01M2,N0:m2I , MHO (NO  I M2, X0IM2I ,NHE (NDIM2  *  NOT M2 1 , 
lMMF(N0iM27N0lM2l ,WUU(N0IM, NCIMI ,HXX(NOIM,NOIFI , 

IF  A  ( NCI  M2  •  NOI  M2 1  ,3A(NO:.m2,NOIF2I,GA(nO:M2,NOIM2)  , 

1MX  A ( KOI M2 1 ,GCX (XDIM.NDIM)  ,GCZ INOlM.NOIM) , 

1QA (N0IM2, N0IM2I «PXA(N0IM2,N0IP2),PXVA (N0IM2 ,N0IM2I , 

1MU0UT( NOIM I ,NXTOUT (NOIMI ,PXTCUT (NOIMI 

9  £AL  FUCJT(H0!M1  .YDISOIKIJ  ,GUA  (t.DiM2,KDI  K2I  , 

•  .  ■»  — — »  ■»■■■  —  —  —  -  -  ■■■■■  -  —  **•—  — —  —  -  - 


:2i?s; 

:2:«e: 

C2i*7: 
0  21 55  C 
Q2159C 
021951 
C2191C 
521922 
J 21 931 
021940 
02195C 
521962 
021973 
021 965 
021990 
022500 
022310 
022320 
022330 
C  2254* 
022550 
02236C 
522573 
32208^ 
0*22596 
C2210C 
C  22113 
C22123 
C 22133 
022143 
C 22150 
5  22165 
022175 
022165 
522190 
922203 
022210 
522225 
022235 
522243 
022250 
C 22265 
022270 
C22263 
022293 
0  2230C 
Q2231C 
0223 25 
'  6  22  335' 
022345 
C22355 
0  22365 
5  22375 
C 22385 
02239: 
522405 
022413 
022420 
022432 
0  22445 
322453 
C2246! 
022473 
022460 
522493 
022535 


222 


1*0  ( NJ I  'D  .  MLf  IN  (‘.01  >1)  , 

lHU-t-X  ’< 31  *•»  .  P'  T«:n  ,  cat*>  AX  I  r>.»  , 

IPUHJNINOIM)  .P'JmSx  luOlM)  ,GC2i  (NOI.rZ,  NOIMZ)  , 

IRA  t.-.CIM2,S0:“2)  ,3CY  ir-OI^.NCIM  .3CZ  UOIM.kOImi  , 
IN  w3  <N0lN2)  «NV-(N0I*12»  , 

iGcr  <No:*f,Nor«>  ,fc  <n;szm.kpim» 

InTEGE R  IFLGCZ.IRY 
REAL  NU(N0I*1) 

COMMON  /RnTIM/  RNTImE.OELTIM 

COMMON  /HAIN2/C0M2 

COMMON  /NAIM  /NOIm,  NO  I  Hi  «  C  CM 

COMMON  /  INOU/  KlN,*<OUT,KPUM> _ 

COMMON  "/MAI  *L./NOIM2,NOIM3'_' 

COMMON  /MAUN5/  MSG 


;2£5IC 
C  22? 2. 
52253: 
C22SL5 
C2255C 
£ 2256C 

022=r: 

0 225® C 
C  22595 
C 22600 
b  22613 
022520 
0  22  63C 
022660 


-  COMMON  /MAINE/  ICBT .ICBH.'ICFA * ICGA, ICGM, I CGT, ICOA.IRFA, IRFM.IRFT.  022650 

1  IRHT, IRQA, IO.LQG.IRHm. KUMOTS  022660 

-  -  C3gi7: 

N»IT£J<OUT.»» 'ENTER  A  C  FOR  CONTINUOUS  TIME  LOG  CONTROLLER  ANO  A  C22683 
1~CTFCR  A  SAN°LEO  OATA  LOG  CCNTRCLlIR*  *  '0  22691 

REAO  KlN.l2.EN3*  2933) NSG  _  _ _ _  _  022705 

IF  (MSG.EQ.'C'J  THEN'  022713 

IFLGS0*&  022723 

'CALL  CLOGRStGCSTR,FM,BM,P*FSS,HM,C-CX,GCY,GCZ,eCY  .BCZ.FC.YO,  022730 

1  Rm.  .QM.FT  .3T.GT.GT.RT  »HTj _ C227LC 

II R  Y  t  IFlGCZ  «WM1  «NM2  »W US'  C 22 7 5 3 

1  ,P0.GN,NM*.,NM5,NM6.N/l,hW2,t*UU.NXX,X0»NXU,WM7,NM«l  S2276C 

IF  f 10. £0.3 )TH£N  '  022775 

GO  TC  2933  _ _  022703 

EnO  ip  022790 

CALw  FRMAUG(QT.RT «F  T,6T  ,GC2 ,HT ,  GCA , BCZ.FC.GCT  «3CV  «6T  .X0.PC.FA.8A.  022802. 
1  G A. QA«  OU  A  * WM1.NM2  »NMA  » WM8  »  MMC, kMO«  NME* NMF«  022515 

1  MXA,PXA,kA.PxV4,GC2A,IAY_,IPLGCZ«IFLGS0)  022*23 

WRITE) KOUT.*) '  *  C 22 835 

WRITStKOUT.*) '03  YOU  MISH_TC  CALCULATE  TH£  EIGENjh»LUES_CF _TM£  CLQS52256. 
1E0-LC3P  F  MATRIX?  Y  OR  N>'  022355 

_ F.c  A£M*I  N,  12>MSG _ _ _ 0  22  363 

IF  (MSG.EG.'Y*)  THEN  02287? 

NS AV 1*NQI N  _  _  _  _  .  022380 

N0IM*M0IM2  022890 

N0IM1»N0IM2*1  _  _  522903 

WRITE) ROUT,* > 'TM£' EIGENVALUES  OF  THE  CLOSED-LOOP  F  MATRIX  ARE. 0 22913 

_ CALL  HEI6N)FA,Wtf3.WV6.IRFA,wrA) _ C22920 

'  M0IM»NSAV1  022930 

NDIH1*NDIM*1  _  _  022960 

END  IF  022950 

CALL  HYlNTG<WHA,WM3»WMC,N.ME,GA,QA,F  A  ,  3A ,IPF A, ICGA ,1 RY .IRQ A)  0  2296? 

ELSE  322973 

SOME  SAMPLED  OATA  CONTROLLER  IS  WANTED  _  _  _  _  322980 

IFLCSOM  02299? 

WF IT£ (KOUT »* ) *00  YOU  NISH  TC  MERELY  DISCRETIZE  THE  CONTINUOUS  TI-E023303 
"  1  CONTROLLER.  Y  OR  N>*  C 23013 

___  READ  «IN,12,EN0»2«331MSG  _  523020 

IF  IMSG.EQ.'Y'ITHEn  02323C 

WRITE)KOUT.*> '••••••••NOTE  THAT  WHEN  ENTERING  THE  TIME  INCREMENT  02356? 

1  IN  THE  CONTINUOUS 'TIME' CONTROLLER  SET  UP,  REMEMBER  IT  HILL  9ECOC  23C50 
IMS  THE  SAMPLE  TIME  FOR  THE  OISCRETIZEO  CONTROLLER********* '  323?63 

CALL  ClOGRSIGCSTR,FK,BM,RKFSS.HM,GCa»GCY,GCZ,8CY. BCZ.FC.YO,  023C75 

1  RM.OM, FT, BT.GT.CT.RT.MT.IRY, IFLGCZ, HM1,HM2,6M3,P0,GM,  C23080 

1  HM6,HM5,HN6»HV1»HV2,NUU,HXX,X0,HXU,HM7,HN8>  C23093 

_ _ IF_<IO.EO.O>THEN _ _  023 10  3 

GO  TC  2933  ‘  023110 

ENO  IF  023120 

Cm.u  OSCiLTZ tWMl.HMl ,HM3 ,HM6,lr  FH.CEfcTIM.F C»  BCY.IRY.BCZ.IRHM,  023130 

_ 1  WN5  ,HM6.GCSTR.CT.QT,FT,3T,IRFT,ICGT,ICBT,IRHT,RKFSS.RTtGCX,  02316C 

1  ICBM)  ~  '  023153 

—  W»ITE)K0UT,*> '  ' _ _ _ _  0.23  16Jl 


223 


k 


l -w 
LV 
[s' 
[s' 
[s' 
LV 
[s' 


0 


V 


c 

c 


.  "  5  I  I  (  ^  JU  '  1  ”  )  *  j  O  I  j'J  ►  I  T  _  C**bwOlnT«  T  tllil'tk  0?  f  S  l  -  T 

1  £  T?»  iSITI  j  ;  ~ATRI>  T*-=  0IS"iTlZiD  C  5N  T=  5,.Ls.  =  ?  Y  l1  «»• 

ij  «;n,12»  HSG 
IP  <KS3  .El. *Y • )  Th£\ 

W=IT£<K0UT,*l ‘THE  EIGENVALUES  Ce  THE  STATE  TR ANSiTI ON  MATRIX  P0«  T 
1H£  OISCRETIZEO  CONTROLLER  A«E...‘ 

CALL  MSIGMMM2,W*l,NV2.IRFH,eCV} 

ENO  IF  _ 


RKPSS*  IN  PRSCEOI NG  CAu.  STATEMENT  ARE  MERELY  DUMMY  WORK  SPACES 
_GCST R  CONTAINS  8CZ0  UPON  RETURN  FRCK  0SCSTZ 

CALL  FRMAUG <WM6,RKFSStNK5 .GCSTR ,GCZ ,HT, GCX, WML ,WmZ, GCY,  mm3, WK  1, XO, 
1  P 0 1 PA  f BA.GA. CA »SUA « 3CV*F C  »r  N  A  »H  MB «  mHCiHNOi WME • WMF «MAAtPXA.RA. 


wi*l7j 
12315  ; 

"  5»  «  O  • 

C232C5 
C23215 
C 23225 
023235 
023245 


i  pxva,gcza,iry,:flgcz,:flgsc» 

ELSE 

iflgcz»o 


_ CALL  OLQGRS(GCX*GCV«GCZ«BCY<BCZ  .MK3tFCt**M2.  WM5.WH1.WM4,FM,Bk, 

1  QM,  GH, R  M,  HM,  GT,  QT, F  T,BT,F.T.MT,WXX,WUU.  GCSTR,  fiKFSS.YO. 

1  IRY«IFLSCZ,WXU,WM6,HK7,W>ia.WK9«WHl..,HVl,WV2l _ 

CALL  FRMAUGlMMi.NMZtUMS.NRL  ,GCZ,HT,GCX ,BCZ. FC.GCY  ,BCY ,WH5 ,X0^ 

_ 1  FO«FA ,6A,GA, CA,GUA,RKF SS « GCSTR, WMA ,WMB«MMC .WMQ.WKE  «HhF  , MX A«PX A* 

I  RA,PXVA,GCZA,iRY,iF_GCZ,lFtGS01 ' 

C  RXFSS.GCSTR  ARE  DUMMY  WORK_S_PACE_  IN  CALL  TO  FRMAUG 
“  END  IF  '  "" 

NSAV1«M0IN 


NS  A  V 2s NQIM1 
N0IM1*N0IM2>1 


NO IMsNDI M2 

CALL  EQUATE  CM M AjF A  « IRF  A  j  I RFAI 


C2325J 
023263 
023270 
02326: 
023293 
023305 
023313 
023323 
023333 
023345 
023 350 
023360 
S  2337  k 
32338" 
023390 
C  23*0  5 
3 23 LIO 
023123 
023-33 


CALL  EOUATE(WMC«3A,IRFA,IRY) 

CAiL  MATllGA,QA,IRFA.IROA,IROA,WM£> 
CALL  MAT(*(HME,GA,IRFA,IR0A,IRFA,MMB> 

NDIM«NSAV1  _ 

NOlMl«NSAv2 


NOTE  FC  ANC_3CY _ In  CALL  TO  FRMAUG  ARE_ DUMMY  WORKSPACES 

ENO  IF 

_ RETURN _ 


2933  IO>0 

12  F  CRMAT  ( All 


ENO 

♦  OECK  XSU 


SUBROUTINE  XSUIX ,S,U,PHI JO,ejO, PMII ,IMTPII, PHI J,BJ. 

1  TEMP,  TEMPI, TSHP2,FH,BH,IjFM,:CBH,WXX,HUU,WXU, PHI  Tl 

ANO  U  AT  TIKE'  T-SUB-I  FOR  USE  IN  THE 


C  THIS  ROUTINE  COM°UTES  X  S 
C  _  SAMPLEC  DATA  CONTROLLEROETERMIMSTIC  GAIN  CALCULATION. 

C  THIS  ROUTINE  APPROXIMATES  THE  INTSGR AlSREOUIREO  CSEE  MAY8ECK, 

C  EQUATIONS  1h.25I  BY  TREATING  TIKE  VAYING  ENTITIES  IN  THE 
C  INTSGf.NOS  AS  CONSTANTS  CVER'SCKE  SUBINTERVAL  OF  THE  SAMPLE  TIME 

C  THAT  IS  CHOSEN  5Y  THE  USER  _  _ 

REAL  X 


C  23-45 
G2345C 
0  23**6C 
023473 
023L80 
C 23490 
C2350G 
523510 
523523 
023535 
323540 
32355: 
C23563 
023575 
023583 
C2359Q 
023635 
C2361C 
023625 
323635 
023645 


<NOlM,NOIM>.  S(NOIH.NOIM) ,  U(NOlM,KOIKI , 
IPHIJC(NOIM.NOIM)  *BJC(  NOIK.NOIK)  ,  »►*!  I  {  NOIH  ,NOlKI  ,_ 
1INTPII 


(NOIM,NOlM) • PHI J (NCIKtNOlM) ,3J I  NO IM .NOlMI , 
1TEMP  I NOlH , NOIMI  «  IEmPHNOIN.NOIM)  ,T£MP2t NOIK,NOIKI, 
lFMtNOIH.NDlM) ,3M  (NOIM.NDIM ,HXX < NDI K, NOIM ) , 

1MUU 


023555 
02366C 
023673 
023685 
C  23593 
023705 


K. 

REA.  COM1  111  *  COM2  (1 1 

£23'*  10 

['/ 

CHARACTER  MSG*65 

623720 

COMMON  /MAIN1/NO IM *NOIMl ,  CCM1 

023733 

IS 

C0HMCN/MAIN2FC0M2 

0  23745 

COHHCN  /INOU/  KI N.KOUTt  KPLNCH 

023750 

C  OMKON  /rntim/  rntime.oeltim 

023765 

w 

COHHCN  /HAUN5 /  MSG 

623770 

IZIT«0 

023785 

.4 

OO  782  I J<*1» 1000 

023790 

>' 

C  GIVE  USER  U°  TO  15. C  CHANCES  TC  CHOOSE  OIFFEP.ENT 

SUSI NTERv  AL  LENGTH  023803 

4 

IFIIZIT.E0.il  THEN 

323S15 

P 

HPITE«OUT,l2l  •  » 

023825 

1  V* 

224 


vV 


N-  I  TiKOUT  ,*l  '3  j  YOU  hljW  TC  —  COMPUTE  X..S.U,  2iSiD  C%  A  C I FF  EF  E  r.T  5  23  s  3. 
1  SUil'.Tis^iu  .E’IGTM,  >  JR  f>*  C23?-: 

*.EA3K:n,11»mSG  023*55 

FORMAT  (i*»  C2386C 

FCRM  AT  Cl,/)  C23-7C 

IF  (KSG.t3.*s')TH£N _ _  _  G23  2  8: 

R£TU*N~ . .  . -  --  —  023893 

ENO  if  G23933 

ENO  IF  G23912 

IZIT*1  _  _  _  __  _  _  G23925 

WRZTEIKOUT »•) *ENT ER  THE  NUMBER  OF  SUBINTERVALS  TO  USE  IN  THE  APPR002393C 
IX I NATIONS  QF  INTEGRALS  NEECEC  TO  CALCULATE  X.  S,  ANO  U  (SUGGEST  5C23943 


1  03  >032  »>* 

REAO«lN,*»  INTVAL 

NOW  INITIALIZE  VS.3IA3i.ES  :  SQUIrEC  IN  CALCULATIONS 
_  Cl*l.C  _ 

call  iontcirfm.phijo.cd 

Cl*  j  .5 

CAl„  I0NT(IRFN,X.CH  ■ 

CALL  I0NT(IC3H,U,C1I 

.  00  13  I*lt IRFk 

00  13  J*1,IC3M  _ 

8J0 ( J) * j 

S(I,JI*0 

iNfT'IALiZATICN  COMPLETE;  non  COMPUTE 'PHI j,  INTPMJ  "F03“SUaiNTERvAL' 


13  S(I,J>*0 

C  INITIALIZATION  COMPLETE;  NON  CCHPUTE  PHI  J,  I  NT  PH  J  ~F0  R"SU  31  Nf ERVAL* 
C  PMI.INTPHI  A3E  APP3CXIHATE0  BT  TAKING  AVERAGE  OF  VALUES  AT  THE 
C  BEGINNING  ,£N0  ANO  6  POINTS  IN  THE  NIOOuE  OF  EACH  SUeiNTERVAL 
C  THIS  MEANS  9  SUB  SUB  INTERVAL  POINTS  TO  BE  CALCULATED.  HOWEVER.  0 
C  NLV  1  CALL  TO  INTEGRATE  30UT2NIS  REQUIRED  SINCE  Fh  IS  A  CONSTANT 
C  MATRIX 

"OEL*:.fi  — 

SU92KT«0£LTIM/(L* INTVAL) 

00  23  JO  1.  INTVAL 

C  COMPUTE  PHI J  3J  ANO  THEN  UPOATc  PHIJC.eJO 
C'  FCR  EACH  SU8INTERVAL  ' 

Ci*1.3  _ 

"  GO'  371  “lift VL*  1.4 
_  0EL*CEl*SU3INT 

CALL  0SCRT(IRFM,FM,0£.~,PHli;iNTPII,9» . 

CALL  MAOOl ( I3FM. I3FM. PHIJC.PHXX.TEHF.C1I 
CALL  E0UATE(PMIJ0,TEMP,IRPM,IRFP» 

C  PHI JC*PHIJO*PHII 

CALL  M  a  t  hi  NT  p;:  .aKTl'-F  H.  IT'TTT C  Bm.'TEmPiT 
CALL  HAOOl ( IRFm.ZCBM.3J0. TEfFI .TEMP  .Cl) 

CALL  E0UAT£(SJ0.TEHP,IRFM,ICEP> 

C_  BJO»8JO*lNTrII*BM 
371  CONTINUE 

C  NON  CALCULATE  8J  PHIJ _ 

Cl*  w .2 

CALL  MSCALE(*MIJ,PMlJO.IP.F|«tI?FM,Cl) 

CALL  MSCALE (3 J.BJO. IRFm.1CBF.CH 
C  8J»  PHiJ  NON  AVAILABLE  FO?_THIS  SUBINTERVAL  _ 

C  RESET  PHI  JO. 9  JO 

_ CALLJQUATEIPHIJO.PHII.IRFM.IFFH) 

CALL  EQUATE(BJO,T  JHP1.IRFF.IC3N) 

C  NOr  UPOATE  X.S.U  FOR  THIS  SU3INTE3VAL 
C  X*SUM  OF  (PMIJT*NXX*PHIJ* (OELTIF/INTVALI)  FOR  ALL  JK 
C  S«SUM  CF  I (PHI JT*NXX*8J*PMIJT*KXUI* ( DE-TIM/I NTVALI ) 

CALL  MAT«A(PHIJ.NXX.ZRFF.IRFF,IRFm.TEmP) 

C  TEMP*  PHUT  *  WXX 

CALL  MA  T 1  (T  £  H  P  ,  P  H I J  ,  I R  F  H,  I RF  FV I R  FF  ,T  £  m'P  1  )' 

CALL  HAU(T£MP,9J,IRFM,IRFK,IC9M,TErtP2) 

C1A*0ELTIM/INTVAL 

_ CAtL  MAOOKIh.FM.IRFH.X tjejf Pi. TEMP, Cl A) 

CALL  EIUATECX, TEMP, IRFH,I®FfV *' 

C  X  IS  NON  UPQATEO  FOR  Thjs  SUE-SUB  INTERVAL 


023950 
023963 
023973 
023999 
023993 
024033 
024313 
G2402C 
C24330 
0  2*.  9  40 
024050 
024360 
024070 
C 24080 
0240 90 
524103 
024 115 
024123 
024130 
C  24140 
024153 
024160 
324170 
C  24180 
"C  24 19  C 
024200 
024210 
024225 
024230 
_0242nQ 
024250 
024260 
02-270 
G 24 26 3 
024293 
024333 
324313 
C24325 
024330 
3  24  343 
3  24  35  3 
G  24  36  j 
~C  24373 
324363 
024393 
024403 
024413 
324423 
3  24-33 
02444; 
5  24450 
024460 
»  2447  3 
02-480 


',\y«y.v «y„v .y  „y.v.v.  . 


>.V- 


rs-'v' VTV  V.«  iTMW 

\v> 

v.? 

IV  ' 


K  \  »  ■  ?"“_,..-.’.v 


1  *■-  rr  *r 


MV 


K'A 


r.s_.- 


§ 


1 

IPS 

b<A 

yv< 

■v-N 

>  V 


[n^ 


call  -i4T,i (3H:j,h7.u,:-Pf-,:=Ff,ic=Mt  jemrd 

c  i  *  i  .  c 

Ciwi.  '14C01  (I?,rM.:C3'<.T;HP2,T£l'0:,TEMF,Cl) 
CALL  *4001  <  ie?*.:CS*.S,T£“°  ♦T£»i=l,Cl4  ) 

CA wL  E3>J4Ti(S«Tt*  =  l«I"P^fIC2*) 

S  UPDATE  PQS.  THIS  SUE-SU3  :  NT£»  y  Ai.  NOW  COMPuETE 


caw-?: 


c 

c 


U»SUM  OF  <  <3JT*  MXX*6  J*MUU*3  JT*_WXU*h  XUT*  9J)*(DELTIm/InTVAL)>  PCS  ALL  JK 
Ci«l.C 

_  CALL  HAT3Ai:C3H.I4FN,aj«WXX»TENP) 

CALL  M4301  < XC3H<XC3H<  TEMP  <ML'U<  TEMPI  <Cl> 

_ CALLMAT4 A  (  9J  <WXU<ICBM<  IRFM.IC8M.TEHP)  _ 


CALL  MAC0HIC9M.IC9K.TEMP1 .  TEmP  ,  TEfiPE.SD 
CALLNATwA  <MXU<3J<IC3M<  IP.  PN.IC8M.TENPI 
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CALL  MA001<IC3M.ICBM,TEHP2, TEMP, TEMPI, CD 
CALL  MADQl <ICfiH,ICBM,U,TEMPl,TEKP,ClA) 

CALL  e<JU4T£CU,T£MP,ICBM.iCBK» 
u  UPOATB  FOR  THIS  SU3-SUB  INTERVAL  NOw  COMPLETE 
CONTINUE 

IO*S  _ 

MSG*  *X  <TI  >  IS  * 


CALL  NMAT  IO<X,IRFK,IR*M,IO.  KIN, KOUT  ,N0IM , NO  IM) 
MSG*'U(TI»  is  • 

C  A  Lw_M*AT  10_<  U  ,IC  3. IC3H<IC<XIN<K  CUT  ,  NOI K  ,  NO  I M ) 
MSG*,'S<fil 


IS1 


782 


CALL  MMATIO(S<XRFK. XC3M<XC<KXN<  <0UT <N0IM<  NDIM ) 
CONTINUE 

RETURN _ _ _ 

ENO 


_SU 9». GU  TDIE  CNOISE  (FM«GM<Hn,a>i, QM<IRFM<IPHP<  ICG*<  ICBM<MM1<NM2<MMJI 
OIMENSION  F  N  <  NO I M , NO I M I  <*H>'(  NOlM,  NDI  M»  <  BM  C  NO  IM  <  NOIM  «  OM(  NO  IM  ,NOI  MI  , 


© 


V 


25 

C 


10 

20 


lGM ( NOI M<  NOlMt ,C0Ml<ll  <MM1<NOIM<NOIHI <MM2<NOIM<NOIMI  <MM3  <NOlK<NOIM) 
C0MHCN/MAIN1/N0IK,N0IM1,C0M1 
CO MMCN/I NCUZ<1N<KCUT<KPUNCH 
FORMAT <111 

MRITE<<OUT<M »1ST  OR  ZNC  OROER  SHAPING  FILTER  <1  OR  2)>» 

P.E4Q  <KIN,  25)  IS1ZE 

CALCULATE  TH£  OINENSICN  OF  THE  AUGMENTEO  SYSTEM 
IRFS*IRFM* < IS IZE* ICBM) 

IF  <ISIZE<NE<DGO  TO  11 

CAlL  FOE.OER  <F  M<  BN  <GM<OM<HM<  IFF M<I?»HM <I2BH<ICGM<IRFS  ,MHi) 

GO  TO  25 

~£a ll  soaos r?1fm,bm,,gm<om,»*m,ir fm , fRHM < ic bmTHTm, ffi FS < MM1 , M »2 


«t 

/  j; 

>,mr3i  o; 


CONTINUE 
RETURN 
ENO 

SUBROUTINE  F0R0ER<FM,3n,Gm,CM<MM,IRFM,IRHM,ICBM<ICGM,IRFS<hU) 
OINENSICN  FK<I<OIM<NOI  Ml  <9M  <  KOIM  ,NOX  M>  <GM<NOIM<NOXM  <  QM<  NDlM«NOlM)  < 


in  m  <  KOI m  <  NOI M) ,C0M1(1) .COM2 (1) <HU<nq;m,NO:m) 
C0NMCN/MA:N1/N0IK,N0Ik1,CCM1 
COMMCM/MAIN2/COM2 

CCMMCnZInCU/KIN<KCUT<KFUNCH  _ 

C0MMCN/MAUN5/MSG 
REA*.  SNTRI  <ENTRY1 


CHARACTER  MSG*6i 
ZERO  OUT  BOTTOM  PARTITIONS  OF  GH,9M,Gn 
IFS*IRFm*1 
IGS*ICGM*1 
XCGSaXCGM«XCBM 

CALL  ZPART<FM<IFS<D <ICBM,IRFS) 


CALL  ZPARTOM  <IFS<D<IC3M<ICBM 
CALL  ZPAST<GM<IFS<D <:C3M,ICGS) 
CALL  ZPART<MM<1<IFSI<IRHM<IC6M 
CALL  ZPAaT<0M<IGS.D.:C3N,ICGS> 
CALL  ZPART  <9M<1,XGS),XCGM,ICBK) 

call  zpartihu.icbk.icrm) 


52451 : 
52-520 
52-533 
3  24540 
62x5s: 
52-56C 
52457: 
024.563 
32-593 
02W600 
024.613 
0246 20 
024.633 
0  24.64  C 
024653 
_0  24663 
0  24673’ 
0  24.68  3 
024690 
0247C3 
024715 
C2<*723 
02-730 
02474C 
024750 
024763 
02477J 
024730 
024793 
024*00 
32481: 
02462 j 
024833 
024640| 
024350 
024963 
024370 
024860 
324390 
024900 
0  24913| 
024920 
0  249331 
024945 
024  9531 
£2496C 
524973 
02490C 
02499C 
0  25  3  0  C 
Q2s:i: 
025023 
925533 
0  25  C40 
52535: 
02556C 
025370 
025  505 
025395 
0  25 1 C 1 
C  25115 
025125 
025133 
025 140 
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,v:^:vwv;v 


-s .V1'1  -*- V  -4-^1  *-~V  V~  -.H'-*.'  V*  V'  «.**  ■*  - 


.•«  .V 

.'VC 


FCR 


SAC*  CCr.T-.OL  CHANNEL 


oesisn  cn-  $ h aP :n j  fi-tcr 
o:  o.  ic*:.:c=m 
w:ITEC<3UT»*)  *FILT£S  OESI  S'.  ‘.IF 
Ws I T £ { KOU T ♦ *) ‘INPUT  OPTIONS*  <i) 
1121  ENT  £Se  Q,  13)  C-0  TC  NEXT  FILT£S 

_ 00  ** w  i.  T*i ,  50  _ _  ^ 

FORMAT <li) . . 

WRITEUCUT,*)  *OFTION>  * 

'  REA0t«IN.27)I0PT 
GO  TO  I  1*2.  3)  I  OPT 
WRXTE(KOUT  »•)  'ENTER  A  AMD  0>  * 

R£AO«lM**l  ENTRY  * ENTRY 1 _ 

MU  liFtifl  sENf-vt-ENTriYl 

FHj  «  IRFP*IF  ),  tI»FM*IF)  )«-l*£KTRYl 

GO  TC  93 

MRITEIKOUT,*) ‘ENTER  Q> « 

READ  «IN»* )  ENTRY 

OM<  <ICGP-*IF),  <ICGP*IFI)*ENT5Y 

GO  TC  9: 

CONTINUE 

continue 


ENTER  a  AND  5, 

OP  EXIT  IF  OOhE* 


CONTINUE 

CALCULATE  3M*HU  AND  PUT  IN  UPC£P  RIGHT  PARTITION  OF  FH 
CALI.  NAT1(BN,MU,ISFP,:C3M,IC8F,FN(1,:FS)  > 
insert  9n  into  up»er  right  partition  "of  gh,  ou*i 
CALL  EQUATE  (GPd.IGSI  ,0P,  1RFP,!C3K> 

PUT  AN  IDENTITY  MATRIX  IN  LOWER  RIGHT  PARTITION  OF  GM 
CAlL  X0NT<XC3M,GM<XGS.XGS>«1.> 

CHANGE  COLUMN  01 ME  NS I ON  OF  GM  ANO  ORDER  OF  SYSTEM 
ZC GMsICGS 
I=FM«IRFS 


IHOLO=IO 

10*5 

MSG*  ‘OMAUG* 

CALL  MMATIOUJM, lCCM.ICGM, IC . WIN .KCUT.NDI N ,NOlM> 

_IO*IMCLD _  _ _ 

RETURN 

ENO 

"SUBROUTINE  SOROSR (FH,6H*6m»QP ,HH,IRFM,IFHP, ICSK .ICGM.IRFS* 
lHUtFU.  GU) 

DIMENSION  F M I NOI N » NOI Ml  *8M (NOXM.NOlM) *GM( NO IM.NOIH) . 
lOMjNDI M ,  NO  I M)  ,  HMJ NDIM,  NOI P  )  ♦  MU  I NOI M ,_NJIM )  *C  OM 1  (1)  . 

1C0M2  (1 ) »FU  CNDIM*  NOIP) *GU( NOIP  *KOIP)~  ~ 
COMMCN/nAlNl/SOlM.NOlMltCOMl 
C0MMCN/MAIN2/C0M2 


commcn/incu/win,kcut,wpunch 
C0MMCN/MAUN5/MSG 
REAL  ENTRY ,£NTRY1,3AC.BTC 
IFS*IRFm*i 
IGS*ICGM*l 
ICGS*ICGM* IC3M 
_ IC8W2*2*ICBM 

CALL  ZPARTLFMllFS.ll  *iC0M2,IRFS) 

CALL  ZPART(3MIIFS.1).:C8M2.IC3M) 

CALL'ZPART  IOMilIGS.1)  ;:C3M,!CGSl 
CALl  ZPART<QM<i.IGS),ICGM,ICEP> 

'  CALL  ZPARTf GM  <IFS  .11 ,ICBM2,ICGS  ) 

_ CALL  ZPART<GM<1,ICS>.IRFN,IC0p)  _ 

CALL''ZPARTIHMI1»IFS),IR'MM*ICBH2) 

CALL  ZP ART ( FU. I CBM2 .ICBM2 1 
CALL  ZPART 1MU.IC BP » IC9M2) 

CALL  ZPARTIGU*ICBM2,ICBMl 
OESIGN  ONE  SHAPING  FILTER  PER  CONTROL  CHANNEL 


DO  09  IF*l,IC3M  _ _ 

WRITSU3UT,*)  ‘FILTER  DESIGN*',  I'F 

WRIT £(< JUT**)  ‘InPUT  OPTIONS  1  <11  ENTER  C,  12)  ENTER  0  A.riP_-* 


CEElE. 

2  2516 3 

32517C 

325103 

2  25191 

S252C2 

325  21 C 

C25  2  2  2 

025232 

025 2 AS 

C  25  253 

C  25263 

6 25 27 C 

025 20C 

C 25  29 C 

0253SC 

C 25312 

025  3  2C 

025338 

G2534C 

C25  35C 

E  25 360 

C2537C 

325330 

025  390 

G25lOC 

0 25410 

025420 

225432 

325440 

C2545G- 

225462 

025470 

G2546C 

025492 

825502 

825512 

C25523 

C  25533 

C2554C 

0  25552 

225568 

025  5  7  0 

325502 

C25593 

C  25  69  2 

2  2=613 

025622 

025632 

825 643 

225652 

0  2566  9 

025670 

325602 

025693 

025799 

025710 

C2572C 

025730 

2  25  74  C 

C 25 75 2 

025762 

C2S77C 

025702 

025  790 

Jjseoi 


1(2)  £*J  T  £  »  0 
Oc  IT*i  it  C 
4=IT£(<3UT,*)  *ir  T  *Or.  > 
26  FORMAT  (ID 

R£A3  KI N,  2! )  IOPT 
_ GC  TO  (1,2,3,-) IC'T 


(-)  GO  TO  •)£  >:  T  FILTi?  (D  EaIT 


30n£' 


WRITEIKOUT,*)  ‘ENTER  A>  » 

P.EAO  KIM, •>  ENTRY 
hu(1F,  (2*lF-u ) » Entry 
_HU(IF, I2*IF>» «i. 

GO  TO  95  . .  ' 

WRITEIKOUT ,•) ‘ENTER  9  ANO  C>  ' 
RUDKIN,*)  ENTRY, ENTRY1 
BAO«-l* (ENTRY*® NTRY1) 
BTC*-1*(£NTRY*ENTRY1) 

FU((2*IF-1> , (2*IF))«1, _ 

FU((2*IF> , (2*IF-1»)»8TC 
FUM 2* IF )  ,  (2*IF )  )»BAC 


90 

4 


GO  TC  93 

WRITE! KOUT,*J ‘ENTER  Q>^ 

REAO  (KIN,*) ENTRY 
QNC(ICGM*IF),  (ICGF^IFI )  »  £  N  TRY 
CONTINUE 
CONTINUE 


GU  (  (IF* 2)  ,IF  )  »1. 

SO  CONTINUE 

C  CALCULATE  9“*MU  ANOPUT  In'uPPER  RIGHT  PARTITION  OF  M 
__  CALL  NNUL  (9N,HU,IRFN,IC32^,ICfi)'2 ,Fm(i,:FS)  ) 

C  I NSERT  ~FU  INTO  LOWER  RIGHT  PARTITION  OF  FH 
CALL  EQUATE (FH(IFS,IFSI ,FU,ICBH2,ICoH2) 

"C  INSERT  GU  INTO  LOWE®  RIGHT  PARTITION  CF  GM 
CALL  EQUATE (Gh(IFS«IGS) ,6U, ZC3K2, IC3M) 

C  CHANGE  COLUMN  DIMENSION  OF  GM  ANO  ORDER  OF  SYSTEM 
_  ICGH«ICGS 

xrfm»:rfs  "  . . 

return _ 

END 


325523 
C  2  5  5  3 1 
02564, 
025*50 
:25?e: 
C2557C 
0  25  !  8  ? 
025 89C 
C25900 
025913 
J25925 
C2593C 
025943 
02s  952 
62596C 
C2S97C 
C25995 
C25  99C 
026303 
026313 
026320 
026333 
0  26  3  40 
C2635S 
026 360 
0  26  u  7  u 
0263 80 
026393 
026133 
026113 
026123 
026130 
026  143 
0261501 
026 16C 
026170 


Copy  available  to  DTIC  does  not 
permit  fully  legible  reproduction 


228 


APPENDIX  C:  Modifications  and 
Additions  to  CGTPI 


C.l  Introduction 

This  appendix  is  intended  to  be  used  as  a  supplement  to  References 
13  and  30.  These  sequences  are  user's  guides  to  a  computer-aided 
design  program  for  designing  controllers  employing  a  Command  Generator 
Tracker  in  the  feedforward  loop  and  a  Proportional-plus-integral  regulator 
in  the  feedback  loop  (CGTPI).  Reference  13  describes  the  original  version 
of  the  program.  Reference  30  contains  a  modified  version  that  admits 
implicit  model  following  for  design  of  controller  gains  and  that  can  be 
run  in  conjunction  with  a  performance  evaluation  program  (PFEVAL) , 
described  in  the  same  reference.  Modifications  outlined  in  this  chapter 
are  made  to  the  version  in  Reference  30. 

As  stated  in  Chapter  III,  only  the  PI  regulator  design  portion  of 
the  program  is  used  for  this  thesis.  However,  to  execute  PFEVAL,  the 
user  must  first  execute  all  three  design  paths  of  CGTPI.  These  include 
the  PI  regulator  design,  CGT  design,  and  Kalman  filter  design.  By  proper 
choice  of  the  CGT  model  matrices,  the  controlled  degenerates  into  a 
simple  PI  regulator.  These  matrices  are  defined  below: 


A  - 

m 


[I] 


(C-l) 


B  -  [0] 
m 


(C-2) 


C  - 

m 


[0] 


(C-3) 


D 

m 


[I] 


(C-4) 


Modifications  to  the  program  include  an  additional  subroutine  to 
apply  the  Doyle  and  Stein  technique.  This  is  bracketed  and  marked  with 


an  "A"  in  the  source  code  at  the  end  of  this  appendix.  Modifications  to 
allow  inputting  colored-noise  into  the  design  model  are  bracketed  and 
marked  with  an  ,fM".  Since  the  modifications  made  to  CGTPI  are  not 
extensive,  only  the  specific  subroutines  that  contain  changes  are  listed. 

C.2  Additions  to  CGTPI 

One  additional  subroutine  is  added  to  CGTPI  to  allow  modification  of 
the  dynamic  driving  noise  covariance  matrix,  Qd>  via  the  Doyle  and  Stein 
technique  as  described  in  Section  3.4  Subroutine  DAS  is  listed  in  lines 
29730  through  29940.  When  executing  the  Kalman  filter  design  option  of 
CGTPI,  this  subroutine  is  called  in  line  18730.  An  input  prompt  will 
ask  if  the  Doyle  and  Stein  modification  is  desired.  If  so,  then  a  prompt 
will  ask  for  the  scalar  design  parameter,  q.  The  matrix  is  then 
modified  as  expressed  in  Equation  (3-43)  with  the  assumption  that  V  ■  I. 
The  modified  Qd  matrix  is  also  written  to  the  LIST  file. 

C.3  Modifications  to  CGTPI 

The  original  version  of  CGTPI  was  not  written  with  the  intention  of 
augmenting  additional  states  with  the  design  model.  The  modifications 
listed  in  the  source  code  in  this  appendix  will  allow  the  technique  of 
injecting  time-correlated  noise  into  the  design  model,  but  the  method  is 
awkward  as  will  become  apparent. 

To  apply  the  technique  requires  two  executions  of  CGTPI.  In  the 
first  execution,  the  unaugmented  design  model  and  truth  model  are  entered 
to  the  program.  Then,  the  PI  regulator  design,  CGT  design,  and  Kalman 
filter  design  paths  are  executed  normally.  All  prompts  to  enter  either 
filter  gains  or  CGT  gains  should  be  answered  with  an  "N".  In  the  CGT 


design  path,  the  model  matrices  listed  In  Equations  (D-l)  through  (D-4) 
can  be  entered  if  only  a  FI  regulator  is  desired.  It  is  useful  to 
write  the  truth  model  to  the  SAVE  file.  An  input  prompt  asks  if  it  is 
desired  to  write  the  model  to  the  SAVE  file.  If  a  "7"  is  entered,  the 
model  matrices  are  stored  by  the  program.  This  file  is  structured  so 
that  the  design  model,  truth  model,  regulator  gains,  CGT  gains,  and 
command  model  can  all  be  written  to  the  file  for  later  use.  Copying  the 
SAVE  file  to  a  DATA  file  allows  the  model  and  gain  matrices  to  be  read 
directly  into  the  program,  rather  than  be  inputted  from  a  terminal 
(Ref  13).  The  regulator  and  CGT  gains  are  also  written  to  the  SAVE  file. 
After  following  all  three  design  paths,  execution  of  the  program  is 
halted. 

Prior  to  the  second  execution, the  SAVE  file  is  copied  to  a  DATA  file. 
Also,  it  is  necessary  to  have  the  augmented  matrices  specified  in 
Chapter  IV  available  to  be  read  into  the  program  from  the  terminal.  In 
the  second  execution,  the  augmented  system  is  entered  into  the  design 
model.  The  truth  model  can  be  read  from  the  DATA  file  containing  informa¬ 
tion  from  the  previous  execution.  After  entering  the  model,  the  CGT  path 
is  followed  again.  A  prompt  will  ask  if  it  is  desired  to  read  in  the 
CGT  gains.  A  "7"  is  entered,  the  gains  are  read  from  the  DATA  file,  and 
this  path  is  exited.  This  modification  is  listed  in  lines  6600  to  6630 
and  6910. 

Next,  the  Kalman  filter  design  path  is  followed  with  the  augmented 
design  model.  After  execution  of  this  option,  a  prompt  will  inquire  if 
it  is  desired  to  store  performance  analysis  data  to  the  SAVE  file. 

A  ”7"  is  entered,  and  another  prompt  will  inquire  if  it  is  desired  to 


read  controller  gains  from  the  DATA  file.  Again,  a  "Y"  Is  entered.  The 
modifications  In  lines  27230  through  27430  allow  the  program  to  read  In 
PI  controller  gains  from  the  previous  execution  and  augment  with  columns 
by  zeros  so  that  the  shaping  filter  states  are  not  fed  back  through  the 
controller.  Performance  evaluation  data  is  stored  and  PFEVAL  can  thus 
be  run  normally  as  described  In  Reference  30. 

The  modified  version  also  allows  the  option  of  reading  in  Kalman 
filter  gains  from  a  previous  execution  stored  on  the  DATA  file.  These 
modifications  are  listed  in  lines  4230  to  4320. 

Final  modifications  are  given  in  lines  4470  through  4610  to  reformat 
the  PI  controller  gains  and  allow  storage  room  for  the  augmented  zeros. 


fc: 


.s 


2960*  SUBROUTINE  CGTXO 

2970*  COMMON/MAIN1/NO IM,NDIM1 ,COM L  < 1 ) 

2980*  COMMON/ MA I N2/ COM2  <  ]  ) 

2990-  COMMON/ INOU/KIN , KOUT , KPUNCH 

3000*  COMMON/DES IGN/NVCOM , TSAMP , LFLRP I , LFLCGT , LFLKF , LTeUAL , LABORT 

3010*  COMMON/FILES/KSAUE,KDATA,KPLOT,KLIST,KTERM 

3020*  COMMON/SYSMTX/NVSM , SM< 1 ) 

3030-  C0MM0N/ZNTX1/NVZM,ZM1U> 

3040-  C0MM0N/ZMTX2/ZM2 ( 1 ) 

3050-  COMMON/ND  IMD/NND  ,  NRD  ,  NPD  ,  NMD  ,  NPD  ,  NMD  ,  NWDD  ,  NPL.  D  ,  NWPMUD ,  NNPR 

3060*  COMMON/LOCD/LAP ,LGP ,LPHI , L3D,LEX , LPHP , LQ , LGN ,LOD ,LC , LDY , LEY 

3065*  t,LHP,LR 

3070*  COMMOW/DSNMTX/NVDfUNCDY ,  NOEY , DM< 1 ) 

3030-  COMMON/NDIMC/NNC ,NRC » NPC 

3090*  COMMON/LGCC/LPHC , LBPC , LCC , LDC 

3100*  CGMMON/CMOMTX/NVCM  ,  NEWCH , NOOC , CM ( 1 ) 

3110-  COMMGN/NDIMT/NNT , NRT ,NMT , NWT 

3120-  COMMON/LOCT/LPHT ,L80T , LQDT , LHT , LRT ,  LTDT , LTNT 

3130*  C0MM0N/TRUMTX/NVTM,TM<1> 

3140*  COMMON/LCNTRL/LPI 1 1 , LPU2 ,  LP 12 1  ,  LPI22 ,  LPHDL ,  LBDL 

3150-  COMMON/CONTROL/NUCTL,CTL<1 > 

3160*  COMMON/LREGP I /LXDW , LUDU , LPHCL , LKX , LKZ 

3170-  COMMON/CREGPI/NVRPI ,RPI ( 1 ) 

3190-  C0MM0N/LCGT/LAll,LAl3,LA21,LA23,LAl2,LA22,LKXAU,LKXA12, 

3135*  1LKXA13 

3190*  COMMON/CCGT/NVCGT,CGT ( t) 

3200-  COMMON/LKF /LEADSN , LFLTRK , LFCOV 

3210-  COMMON/CKF/NUFLT,FLT<1> 

3220*  COMMON/AMC/AM  < 1 > 

3230-  COMMON/BOG/BO  < 1 ) 

3240-  DIMENSION  LD< 13) ,ND< 1S> 

3230-  DATA  NPLTZM/606/ 

3260-  DATA  IE0I,N0/-1,1HN/ 

3270-  REWIND  KLIST 

3280-  WRITE (KLIST, 115)  DATE(BUM> ,TIME(DUH> 

3290-  WRITE < KTERM ,113)  BATE (BUM) , TIME(DUM) 

3300-  115  FORMAT ( *  1  * , 27X , ’ *  *  *  CGTPIF  *  «  *’/14X, 

3310*  1  ’PROGRAM  TO  DESIGN  A  COMMAND  GENERATOR  TRACKER */8X > 

3320*  2  ’USING  A  REGULATOR  WITH  PROPORTIONAL  PLUS  INTEGRAL  CONTROL 

3325-  1 */16X» 

3330*  3  ’AND  A  KALMAN  FILTER  FOR  STATE  ESTIMATION. ’/28X, 

3340-  4  ’*  *  *  CGTPIF  *  *  *’//! IX, ’DATE  ;  ’,A10//,11X, 

3350-  5  ’TIME  :  ’,A10////> 

3360-  REWIND  KSAUE 

3370-  REWIND  KDATA 

3380-  WRITE (KSAUE, 112)  IEOI,NPLTZH 

3390-  DO  10  1-1,15 

3400-  10  ND< I)»0 

3410*  DO  12  1-1,15 

3420-  12  LD< I >-l 

3430-  LFLRPI *0 

3440-  LFLCGT-0 

3430-  LFLKF-0 

3460-  LTEVAL-0 

3470-  LABORT-O 

3480-  IPI-0 


\’.\r 
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7490a  ir<3T*0 

35<)0*  ITRU-0 

3510»  IFLTR-0 

3520*  ICODE-4 

3530*  LFAVAL-0 

3540*  LGCGT-0 

3550*  NVC0M«M.TN©!NDIM»NV2M) 

3360*  K0UT*KLIST 

3570*  KPUNCH-KPLOT 

3330*  IFINVSM.GE.NPLTZH)  GO  TO  30 

3590*  WRITE  101 # NPLTZM 

3640*  GO  TO  1000 

3610*  50  WRITE  102 

3620*  READ*,TSAMP 

3630*  IF!TSAMP.L£.0. >  GO  TO  50 

3440-  WRITE<KLIST. 103)  TSAMP 

3650*  103  FORMAT! 'OSAMPLE  PERIOD  IS  * ,F3.3,*  SECONDS*) 

3660*  CALL  SETUP  I ND*LD, ICGT , ITRU, 1 > 

3670*  IF  ! LABORT)  1000,100,1000 

3630-  100  LABORT-O 
36? 0*  WRITE  104 

3700*  104  FORMAT ! * ©CONTROLLER  DESIGN  <Y  OR  N)  >*) 

3710*  READ  1 1 J , IANS 

3720*  1F( I ANS.EQ.NO )  GO  TO  500 

3730*  LFLKF-0 

3740*  CALL  PIMTX(IPI) 

3750-  TF ! LABORT)  1000,123,1000 

3760*  123  WRITE  103 

3770-  103  FORMAT! 'OBESTGN  RFG/PI  !  Y  CR  N)  >•) 

3730-  READ  111, IANS 

3790-  IF(IANS.EQ.NO)  GO  TO  150 

3800-  CALL  SREGPI 

3810-  IF (LABORT)  1000,200,1000 

3320-  t30  WRITE  106 

3830-  106  FORMAT! ’ODESIGN  CGT  (Y  OR  N>  >*> 

3840-  READ  111, IANS 

3830*  IF! IANS. EQ. NO)  GO  TO  100 

3860*  CALL  SETUP!N0,LD, ICGT, ITRU.2) 

3870*  WRITF  117 

3880-117  FORMAT! '©TERMINATE  CGT  DESIGN  PATH  (Y  OR  N)T  >*> 

3890*  READ  111, IANS 

3900-  IF! IANS.NE.NO)  GO  TO  500 

3910-  IF! ICGT)  155,100,135 

3920-  133  IF! LABORT)  100,160,1000 
3930*  160  CALL  SCGT 
3940-  IF!LABORT)  100,170,1000 

3930-  170  IF1LFLCGT.LE.0)  GO  TO  123 
3960*  200  L ABORT-O 
3970*  WRITE  107 

3980*  107  FORMAT! '©CONTROLLER  EVALUATION  WRT  TRUTH  MODEL  !Y  OR  N) 

3990-  READ  111,  IANS 

4000-  IF !1 ANS.EQ.NO)  GO  TO  250 

4010-  CALL  SEfUP!ND,LD,ICGT,ITRU,3) 

4020-  IF! LABORT)  200,260,1000 

4030-  250  LTEVAL-0 

4040*  260  CALL  CEVAL 

4030-  IF!LFLCGT.£Q.1>  LGCGT-1 

4060-  IF!LFAVAL»EO,O.OR,LGCGT .£0,0)  GO  TO  100 

4070-  270  WRITE  600 


■  ~ave  '  file 


4C30*  .V)C 
4053- 
4090* 
41C0* 
4110* 
4120* 
4130* 
4140* 
4150* 
4140*  405 
'SAVE 
4170* 
4130- 
4190*  500 
4200* 
4210*  103 
4220* 
4230* 
"5240* 
4230*777 
4240* 
4270* 

—  4280- 
4290* 
4300- 
4310* 
4320-505 
4330* 
4340- 
4350*  510 
4340* 
4370*  525 
4380-  530 
4390*  540 
4400* 
4410* 
4420*  900 
4430*  109 
4440* 
4450* 
4460* 
"4470* 

4480* 

4490* 

4500* 

4510* 

4520* 

4530* 

—  4540- 
4330* 
4340* 
4370* 
4380- 
4590* 
4400- 
_4410«910 
4420* 
4430*  100 
4440* 


FQRNAT<*CUfiITF  PERFORMANCE  EVALUATION  OAT A  TO 

n.r  or  ,v ) 

+  ;■  • ) 

READ  111, IANS 
tF(IANS.EQ.NQ)  GO  TO  100 
ICODE-ICODE+1 
r. ALL  PFDATA<  ICODE»ND> 

INUM-IC00E-4 
WRITE  405* INUM 

FORMAT! ‘OPERFQRMANCE  EVALUATION  DATA,  NO.  *  12 » * .WRITTEN  TO 


+'  FILE* ) 

GO  TO  100 
500  LABORT-O 
WRITS  108 

108  FORMAT <  *OFTl  TER  DESIGN  (Y  OR  N )  >•> 

READ  111, IANS 

IF<IANS.EQ.NO)  GO  TO  900 
WRITS  777 

77  FORMAT <  * OREAD  IN  CGT  GAINS  (Y  PR  N)  >*> 
READ  111, IANS 
IF (IANS. EG. NO)  50  TO  305 
IF  (LGCGT.NE.O)  GO  TO  303 
IF  (IFLTR.NE.O)  GO  TO  505 
CALL  READFS  <  Srt , ND , 4 , 1 ERR ) 

LuCGT*ND<2) 

1)3  CALL  FLTRK(tFLTR) 

IF < IFLTR . EO.O)  GO  TO  900 
TF<  LABORT ;  1000,310,1000 
5.10  CALL  SETUP < NO, LD»ICGT ,  ITRU,3> 

IF (LABORT)  300,325,1000 
525  CALL  FEVAL 

530  IF (LABORT)  1000,340,1000 
340  LFAVAL-1 

IF(LGCGT.EO.l)  GO  TO  270 
GO  TO  300 
900  WRITE  109 

109  FORMAT <  *OENO  DESIGN  RUNS  (Y  OR  N)  >*) 

READ  111, IANS 

IF ( IANS • Ed » NO)  GO  TO  100 

IF ( LFLRP I • EQ » 0 )  GO  TO  1000 

NPNTS«NRD*NNPR 

N0( 1)*NPNTS 

ND(2)-LGC(3T 

ND<3)*LKX 

ND<  4)-LKZ 

CALL  FTMTX ( RP I ( LKX ) , SM , NPNTS , l ) 

ND<5)*NPNTS+1 

1F<LGCGT . EQ.O)  00  TO  910 

ND(4)*LKXA11 

ND( 7)*LKXA12 

ND(8)-LKXA13 

NPNTS-NRD*  <  NNONRC  +NDD  > 

ND< 1 )*ND( l ) +NPNTS 

CALL  h  TMTX  <  COT  <  I.XXA  U  )  ,  SM  ( ND <  5  )  )  ,  NPNTS  ,  1 ) 
10  CALL  WFTLED(4,ND(1),ND,SM> 

WRITE  113 
1000  CONTINUE 

WR!TE(KLTST, 110) 


%**_*"*  9  *  •  *  | 


4<450*  rewind  KSAVE 

4440*  REWIND  NPATA 

4470*  REMIND  K'LIST 

4430*  WRITE  110 

1490*  101  FORMAT ( '©INSUFFICIENT  MEMORY  /SYSMTX/,  NFEDt  *,I4> 
4700*  102  FORMAT ( *OENTER  SAMPLE  PERIOD  FOR  DIGITAL  CONTROLLER 
4710*  110  FORMAT < ‘OPROGR AM  EXECUTION  STOP*) 

4720«  111  FORMAT (A3) 

4730*  112  FORMAT  <21 4) 

4740«  113  FORMAT  <  4X  »  *REG/PI  GAINS  WRITTEN  TO  'SAVE'  FILE*) 

47;0-  RETURN 

4740-C  END  SUBROUTINE  CGTXQ 


6390- 

6400« 

6410- 

6420- 

6430= 

6440= 

6430- 

6460= 

6470* 

6480- 

6490- 

6300* 

6510— 

6520- 

6530-  110 

6340- 

6330* 

6360-  3 

6570- 

6330- 

6390- 

N 

t? 

6660- 
6670- 
6630- 
6690-  8 
6700- 
6710-  103 
6720- 
6730-  9 
6740= 
6730- 
6760= 
6770-  10 
6730- 
6790-  108 
6800* 
6810- 
6320-  12 
6830- 
6840- 
6330- 
6860- 
6870- 
6880- 
6390- 


6< 

_  6( 
6< 

6< 


6600- 

6610- 

6620- 

6630- 

'640- 

6630- 


SUBRGUT INE  SCrtD<ND,LB,ICGT> 

COMMON/DES I ON/NVCOM , TSAMP , LFLRPI ,LFLC3T . LFLKF , LTEVAL , LABORT 
COMMON/PILES/KSAUE ,KDATA,KPLOT  »KLI3T  ,><TERM 
CQMMON/SYSMTX/NUSM.SMt 1) 

CCMMON/ZMTXl/NVZM,Zrtl  ( 1  > 

C0MH0N/7MTX2/ZM2  < 1 ) 

COMMON/ND I MD/NND, NR  0 , NPD , NMD , NOD , NWO , NWDD . NPLD . NWPNWD . NNPR 
CQMHQN/ND  T MC/NNC , MRC , NPC 
CCMMON/CMBMTX/NVCM  .  NEWCM ,  NCDC .  CM  ( 1  > 
COMHON/LRKGPI/LXDM.LUDW.i.PHCI  .LKX.LKZ 
COMMQN/CREGP  T /NVRPI , RP 1 ( 1 ) 

DIMENSION  ND<1),LD(1> 

DATA  N0/1HN/ 

UHlTE(KLISr,110> 

F0Rf1AT(////tlX,S<  *9  ‘>,*C3T  DESIGN*, 5<*  **>////> 

NCUCM-0 

IF<LFLRPI>  10.5,10 

WRITE  102 

READ  111, IANS 

IF < IANS >  FQ . N0>  GO  TO  3 

CALL  READFS(SH,NB»4» IERR) 

NSIZE-ND(3)-1 
LKX=NB<  3 ) 

LNZ*NB<4> 

CALL  FTMTX< SM,RPI <LKX ) .NSIZE, 1 > 

IF< IERR.NE .0 )  RETURN 

CALL  MATLST<RPI(LKX) .NRD.NNB, *KX* ,KLIST) 

CALL  MA TLST <  RP I <  LKZ ) . NRO , NRD . *  KZ  * . KLIST  > 

LFLRPI  — 1 
80  TO  10 

IF(LFLCUT.GE.O)  GO  TO  9 
WHITE  103 

FORMAT < ’0SYSTEM  UNSTABLE - OPEN-LOOP  CGT  NOT  FEASIBLE*) 

RETURN 

LKX-l 

LNZ-1 

NSIZE*NRD*NND 

CALL  ZPMRT < RPI < LKX ) » 1 .NSiZF » 1 ) 

IF(ICGT.EQ.O)  00  TO  12 
WRITE  108 

FORMAT < •  MODIFY  COMMAND  MODEL  (Y  OR  N)  >*) 

READ  111, IANS 

ifuans.eq.no>  return 

CALL  RSYS<SM,LD,ND,2. ICOT) 

IF(LABORT.NE.O)  RETURN 
NEWCM— 1 

CALL  P0LES(3M,NNC,2.4M1,ZM2) 

IFvNPC.EQ.NPO)  GO  TO  13 
WRITE  104 
LABORT— 1 
RETURN 

CALL  OSCRTCd  O.ZMt > 


1 


> 


I* 


I 


I 


4? 10-  102  FORMAT <  *  READ  REG/PI  GAINS  FROM  'DATA'  FILE  (Y  OR  N>  >•) 
920-  104  FORMAT < ‘OCQHMAND  AND  DESIGN  MODEL  OUTPUTS  NOT  EQUAL  IN 
4*30-  1 NUMBER* > 

4940-  RETURN 

4950-C  END  SUBROUTINE  SCMD 


A, 


18250* 
13260* 
18270- 
18280* 
18290* 
13300- 
18310* 
18320* 
18330* 
18340* 
13343* 
13330* 
13360* 
18370* 
13380* 
l'J390* 
19400*  103 
18410* 
13420*  1 
13430* 
1944C*  109 
18450* 


SUBROUTINE  FLTftNf IFLTR) 

COMMGN/KAIN1/NOIH*NDIM1  »C0M1 < 1 ) 

COMHON/MA 1N2/C0H2 ( t  > 

COMMON/DESIGN/NUCOM,TSAMP,LFLRPI,LFLCGT.LFLKF,LTEVAL.LABORT 
COMMON/FILES/NSAUF.,NDATA.KPLOT,KLIST.KT-RH 
COMMON/SYSMTX/NOSM , 3M ; 1 ) 

CQHMQN/ZMrxi/NOZM»ZMl<  1) 

C0MM0N/ZMTX2/ZM2  < 1 ) 

COMMON/NDIMD/NND ,NRO , NPD , NMD. NOD , NMU . NUDD . NPt.J . NUOMUO . NNPK 
COMHCN/LOCD/LAP ,  LOP ,  LPH I  ,.*.BD , LEX  ,  LPHD ,  LQ  , LQN  , 3D ,  i.C ,  LD Y  ,  LE Y 
l.LHP.LR 

COMMON/DSNMTX/NUDH  »NODY  ,  NOEY  •  DM<  1 > 

COMMGN/LKF/L.EADSN»LFLTRK ,  Lr  COO 
CQMMGN/CKF/NOFLT .FLT ( 1 > 

IF(NWPNWD.GT.O)  GO  TO  1 
WR I T£  <  KTERH ,  103 ) 

FORMAT! *ONO  DRIOING  NOISES  -  -  FILTER  DESIGN  ABORT* 5 
RETURN 

IF(NrtO.QT.O)  GO  TO  2 
URITS!KTERM« 10?) 

FGPHrtT  <  *0N0  MEASUREMENTS - FILTER  RESIGN  ABORT*) 

RETURN 


18460*  2 
13470*  110 
13480* 
13490* 
18500- 
18310*  tOl 
18320* 
18530* 
18340*  3 
18550- 
13560*  3 
18370* 
13380* 
18390*  103 
13600* 
13610-  6 
13620* 
18630*  10 
18640-  12 
13630- 
13660* 
13670*  106 
18o30* 
13O90*  13 
13700* 
18710*  15 
18720*  18 
*  — TTB730* 

A  lS/40* 
18730* 
13760*  107 


WRITETKLIST.llO) 

F0RNAT<////11X,5< *•*  *>,*PILTER  DESIGN*, 3(*  *•)////) 
NSIZE-NPLD*  < 1 LNPL0+NMD  > 

IF(NSIZE.LE.NVFLT)  GO  TO  3 
WRITE  101 ,NSIZE 

l-ORMAT(  *OINSI.IFFICIFNT  MEMORY  /CNF/,  NEED:  *,I4) 

LABORT-NSIZE 

RETURN 

NDIM-NPLD 

MDIH1— NDIM+t 

IFINUD.EQ.O)  GO  TO  12 

IF<IFLTR,LE.0)  GO  ro  6 

WRITE  103, NUD 

FORMAT! *  ENTER  STATE  NOISE  STRENGTHS:  *,T2) 

CALL  RQUGT3!DM!L0)  , NUD,0) 

CALL  DOCTOR (NWD, DM < LQ ) ,ZM1) 

CALL  MATL3T  !  ZM1 , NUD , 1 , *  Q  * , KTERH ) 

CAU.  MATLST!DM!Ld> , NUD, NUD, *G* ,NLI3T) 

TF<NUDD.EQ.O)  GO  TO  18 
IF(IFLTR.LE.O)  GO  TO  13 
WRITE  106,NWDD 

FORMA  T  <  *  ENTER  DISTURBANCE  NOISE  STRENGTHS!  *,[2) 
CALL  «aU6T3<DM(LGN> ,NWDD,0) 

CALL  DOCTOR  (RUDD,  DM  <  LON  >  .Zfll ) 

CALL  MATLST < ZM1 ,  NUDD , 1 , *QN • , KT£RM ) 

CALL  MATLST<DM(LGN) , NUDD, NUDD, *0N* ,NLI3T) 

CALL  QDSCRT <  DM ! LQ ) , DM  < LON ) , ZM1 , ZM2 ) 

CALL  DAS!0M!L3D)  ,DO().aD>  ,2M1  ,ZM2) 

IF < IFLTR,LE«0 )  GO  TO  19 
URITE  107, NMD 

FORMAT! *  ENTER  MEASUREMENT  NOISE  STRENGTHS!  *,I2) 


239 


v.v.v. 


18770*  CALL.  ftQWGTS  <  CM  <  Lft )  ,NHD  ,0 ) 

18780*  19  CALL  DUCTQRtNMD, 0M< LR> , ZM1 ) 

18790*  CALL  MATLST<ZM1,NMD»1 > ‘R*  ,KTERM) 

18800*  20  CALL  (1ATL3T <0M(LR  >  *  NMD, NMD t  *R  “ » KLIST) 

13810*  25-  CALL  TFRMTX<DM(LHP) ,3M,NMD,NDIH,2> 

18920*  CALL  TPANS2< NMD, WHIM, SM , ZM1 ) 

13330*  LFCQV*LFLTRK+NDIH*NMO 

13840*  CALL  DOCTOR (NMD, DM <LR>  .FLT(LFCOV) ) 

.3350*  CALL  KFLrR(NDIM,>jMD,FLT,ZMl  ,DK(LOD> »FLT (LFCGV) ,ZM2. 

13380*  1  FLT<LFLTRK),SM) 

13870*  CALL  TFSMTX(3M,C0M2,NLUM,NDIM.2> 

1=530*  IA*1 

13390*  DO  30  I*1,NPL0 

'8400*  FLT  (LFC0V-1TI  )*SQRT  (2M2(  IA) ) 

19410*  30  IA»tA+MDir>l 

13420*  CA!  L  AATLST < FLT ( LFLTRK ) , NQIM ,NM0, *KF* ,KLIST ) 

134T0*  CALL  MATL3T  (FLT  (LFLTRK)  , NOT  'I ,  NMD ,  *  KF  ’  , KTERM ) 

13440*  XFLTRal 

18450*  LFI.KF*t 

13980*  111  FORMAT (A3) 

13470*  RETURN 

1S930*C  END  SUBROUTINE  FLTRK 


m 


26970s  SUBROUTINE  PFOATA<  ICODE.ND) 

24980*  C0MM0N/MAIN1/NPIM,NDIM1 ,C0M1 ( 1 ) 

24990*  C0MM0N/MAiN2/C0M2<l> 

27000*  COMMON/  INOli/K  IN  ,  KOUT ,  KPUNCH 

27010*  COMMON/DESI GN/NVCOM , TS AMP  , LFLRP I , LFLCGT ,  l.FLKF , LTEVAL , LABORT 

27020*  COMMON/F RES/KSAVE .  KPATA ,  KPLOT , KLIST ,  KTERM 

27030*  COMMON/SYSMTX/NL'SM.Sm  1 ) 

27040*  C0MMQN/ZMTX1/NUZM,ZM1<1> 

27050*  CCMMON/ZMTX2/ZM2< t > 

27040*  COMHON/NPIMO/NND  »NRD  »NPP . NMD .NPD  »NUO«NWOD , NPLD ,NUPNWD ,NNPR 

27070*  CONMON/LOCD/LAP , L  GP  .LPHI  ,I.MD . LEX ,  LPHD  ,  1.3  ,  i-GN , LQD  .1.2, LDY ,  l.EY 

270/5*  1 , LHP , LR 

27080*  C0MN0N/D5NMTX/NVDM.N0DY .NOEY . 0M( 1 ) 

27090*  COMMON/ND IMC/NNC, NRC  »NPC 

27100*  COMMON/!  .OCC/LPHC  *  L3DC ,  LCC  •  I.DC 

27110*  CCMMCN/CMDMTX/NOCM,MEUCM,MOD:.CM( 1) 

27120*  COMMON/NOIMT/NNT.NRT.NMr.NUT 

27130*  C3MM0N/L0CT /LPHT , LBPT ,  LQDT . LHT ,LRT , LTPT . LTNT 

27140*  COMMON/TRUMTX/NVTM,TH< l) 

27150*  COMMON/LCNTRL/LPIl 1,LPI12,LPI21 ,LPI22,LPHPL .  LSDL 

27140*  CGMHON/CONTRQL/NUCTL , CTL <  t ) 

27170*  C0MMQN/LREGP1/LXDU,LUDW , LPHCL , LKX , LKZ 

27180*  COMMON/CREGPI/NMRPI ,RPi ( 1 > 

27190*  COMMON/UCGT /L A 11 , LA  1 3 , L A2 1 » L A23 , L A 1 2 , L A22 , LKX  A 1 1 . LK  X A 1 2 , 

27195*  ILKXA13 

27200*  C0MM0N/CCGT/NVCGT,CGT<1> 

27210*  CQMMQN/LKF/LEADSN  , LFL  TRK , LFCOU 

27220*  C0MM0N/CKF/NVFLT,FLTC1> 

"2^230*  DIMENSION  ND<1) 

27240*  DATA  N0/1HN/ 

27250-  WRITE  101 

27240*101  FCRMATt "OREAD  IN  CONTROLLER  GAINS?  (Y  OR  N)  >•> 

27270*  READ  103, IANS 

27280*103  FORMAT  <A3) 

27290*  IF  <IANS.Ea.NO>  GO  TO  102 

27300*  CALL  REAPFS<SM,ND,4,IERR> 

27310*  LKX*ND<  3) 

M  —  27320*  LKZ*ND<4> 

27330*  LKXA1 l*ND<  6  > 

2/340*  LKXA12»ND<7) 

27350*  LKXA13-N0<8> 

27340*  NNDP-<LKZ-LKX+1)/NRD 

27370*  CALL  FTMTX<SM,RPt<LKX> .NRD.NNDP) 

27330*  LL»LKX?NRP*NNDP 

27390*  LE*NND-NNPP 

27400*  CALL  ZPART<RPI<LL> ,NRP,LE,NRD> 

27410*  LKZ*LL+NRP«LE 

27420*  LL*LL-CKX?1 

27430*  CALL  FTMTX<5M(LL>  ,RPT<LKZ>  ,NRl).NPn> 

2>440*  i.L*ND<  1)-ND<5>+1 

27450*  CALL  FTMTX<SM<NO< 5) >  »CGT (LKXAll >,I.L, t  > 

2  ■’460*102  ND<  1  >  *NND 
27470*  ND<2)«NRD 
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27430* 

27490* 

27500* 

27510* 

27520* 

27530* 

27540* 

27550* 

27540* 

27570* 

27530* 

27590* 

27400* 

27610*C 

27420* 

27430* 

27440* 

274S0* 

27440*C 

27470* 

27480* 

27490* 

27700= 

27710* 

27720* 

27730- 

27740- 

27750-  90 

27760* 

27770- 

27780*  95 

27790* 

27800* 

27810-  100 

27R20-C 

27830* 

27840* 

27850- 

27840*  105 

27870- 

27380-  200 

27890* 

27900* 

27910* 


27930- 

27940* 

27950- 

27940- 

27970- 

27980- 

27990- 

28000* 

78010* 

23020* 

28030* 


NO  <  3 ) * 
ND( 4 )  * 
NDC  SI¬ 
ND^)* 
ND  C  7 ) * 
ND  <81* 
N0(9>* 
N0(10) 
NOC 11 ) 
NDC 12) 
ND( 13) 
NDC 14) 
NUZMS* 


‘NPD 

i  NMD 

NDD 

NPLD 

NNC 

NRC 

NPC 

■NNT 

*NRT 

*NMT 

-NODY 

-NOEY 

NVZM 


CALL  FTMTXCDMCLPHI) ,SM,NND,NND) 
LL*NND*NND+1 

CALL  FTMTX C DM ( LSD ) , 3M  <  LL ) ,NND.NRD> 
LL*NND*NRO+LL 


IFCNDO.EQ.O)  SO  TO  100 

CALL  FTMTX  C  DM  C  LEX ), SM  C  LL  > , HMD ,  NDD ) 
LL-NND4NDD-FLL 

CALL  FTM  TX  <  DM  C  LPHD ) , 3M  <  LL ) , NDD , NDD ) 

LL*NDD*NRD+LL 

IFCNODY.EQ.l)  GO  TO  90 

CALL  FTMTXCUMCLDY) ,SMCLL> ,NPD,NRD> 
LL*NPO*NRD+LL 
IF  <  NOEY . EQ • 1 )  GO  TO  95 

CALL  FTMTX C  DM  C  L£ Y ) , SM  C  LL  > , NPO , NDD  > 
LL*NPll*NltO+LL 

CALL  FTMTX  <  DM <  LHP ) , SM ( LL ) , NMD , NPLD  > 
I.L=NMt*NPLD+i.L 
GO  TO  200 
CONTINUE 


IFCNODY.EQ.l)  GO  TO  105 

CALL  FTMTXCDMCLDY) ,SMCLL> ,NPD,NRD) 
LL*NPnifNRDALL 

CALL  FTMTXCOMCLHP) , SMCLL' ,NMD»NND) 
LL*NMD*NND+LL 

CALL  FTMTXCDMCLC) .SMCLL) ,NPD,NND> 
LL-NPD4NND+LL 

CALL  FTMTX C CMCLPHC >  » SMCLL) ,MNC»NNC> 
LL*NNC*NNC+LL 

CALL  FTMTX C CM <LB0C >, SMCLL) , NNC, NRC) 
LL*NNC*NRC  H.L 

CALL  FTMTXCCMCLCC) , SMCLL) ,NPC,NNC> 
LL-NPC4NNO-LL 

CALL  FTMTXCTMCLPHT) ,SMCLL) .NNT ,NNT) 
LL-NNTHCNNTFLL 

CALL  FTMTX ( TMCL8DT ) , SMC  LL ) , NNT , NRT ) 
LL-NNT4NRT +LL 

CALL  FTMTX CTMCLQDT) , SMCLL) ,NNT ,NNT) 
L'.=NNT*NNT  F'.L 

CALL  F TMTX(TMO.HT) , SMCLL) ,NMT ,NNT) 
LL-NM! 4NNT+LL 


28040= 

COLL  FTMTX <  TH<  LRT ) .SH(LL) ,NMT,NMT> 

280S0* 

LL-NMT*NMT FLL 

29060- 

CALL  FTMTX<RPI<LKX>,SM(LL> .NRD.NND) 

28070= 

LL-N«n#NND+LL 

28080- 

CALL  FTMTX  iRPIILKZ),  SMC  LD.NRD.NPD) 

23090= 

LL-NRtl*NPO+LL 

28100- 

CALL  FTMTXCCGTCLKXAUJ.SMCLL) ,NRC*NNC) 

23110- 

LL-NRC*NNC+LL 

23120-C 

231  JO- 

IF  ( NDD ,  FC1 , 0 )  GO  TO  3o<> 

281 AO- 

CALL  FTMTX  CCGT  C  LKXA13 ) ,3M(LL> ,NRD.NO0> 

28  ISO- 

Ll.-MROANOO'H.L 

29160- 

CALL  FTMTX < FLT < lFLTRH > .3HCLL> , NPLO, NMD' 

23170= 

LL-NP-LDSlNMU+LL 

23190- 

CALL  FTMTX(TM(LTDT> ,3M(LL> .NND.NNT) 

23190- 

LL-NNDPMNTFLL 

29200— 

CALL  FTMTX  (  i'M  (LTNT )  ,  3M(  LL >  ,NDD»  NNT  ) 

29210= 

LL— NOU*NN f  H-L 

23220= 

GO  TO  310 

28230-  300 

CONTINUE 

23240-C 

28250= 

CALL  FTMTX < FL T < LFL TRK ) , SMC LL ) , NNO , NMD ) 

28260* 

LL-NNO*NMD+LL 

29270- 

CALL  FTMTX  (  TM(  L  TOT)  .SM(i.L)  ,NND.NNT> 

23280- 

LL=NNO*NNT +LL 

28290-  310 

SMCLD-TSAMP 

28300- 

NO' 151-LL 

283 IQ- 

CALL  UFILEPC ICGDE,LL,ND,SM> 

28320- 

NOZM-NUZMS 

29330- 

HUT  URN 

23340-C  END 

SUBROUTINE  PFDATA 

SUBROUTINE  OASCBOtQOtBOPtQP) 

outer 

COM HON/HA IN 1/NOXM 

029690 

COMMON/NOIMO/NNO  *NP  0  * NPO  t NMO  *N00  *NUO  t NMOO«NPLO«  NtlFNMO*  NNPP 

029700 

COM  MON/P  I LCS/KS  A  Ve  «  NO  AT  A  t  KPL  OT*  KLI S  T  •  ICT  CP  8 

029710 

DATA  MQS1HNS 

329720 

WRITE  101 

029730 

POP MATC*OMOOTPT  8  8T  OOTLE  AMO  STEIMT  CT  OP  N»  •» 

029740 

PEAO  102*  IANS 

0  29730 

FQBNATCA34--- 

-  -  -  •  -  -  •  .  -  - - -  - 

. —  «B.76C. 

I  PC  TANS«CB«NO)  RETURN 

029770 

WRITE  103 

029700 

POP  MAT*  *J  ENTER  »'I 

029799 

PEAO  •  •O0AS 

02980* 

QCASsOOAS’QOAS 

029010 

CALL  TPPMTX(BO»0OP*NNO*NPO*2 > 

029020 

I PC MNO«EB*NPLOI  60  '0  19 

929036 

LlsLAOOPCNPLOtNN  0*1 *1 ) 

029040 

CALL  NAT2CNPtOfNRO.BOP.0OP.3P> 

029030 

CALL  RAOOlC  NPLO.NPLQ.QO. QP.OO.OOAS) 

029060 

CALL  MATLST (QO*NPLO .NPLO. •6P**PLIST 1 

029079 

RETURN 

O2900C 

CNO 

02969C 

APPENDIX  D:  Additional  AFTI/F-16 
Performance  Data 


D.l  Introduction 

In  Reference  6,  it  is  stated  that  the  Doyle  and  Stein  technique  for 
Kalman  filter  robustification  is  guaranteed  to  work  only  for  a  minimum- 
phase  design  model.  That  is,  the  model  of  the  system  to  be  controlled 
may  not  have  transmission  zeroes  in  the  right -half  s-plane. 

The  perturbation  equations  of  motion  described  in  Chapter  V  are 
linearized  about  a  trim  flight  condition  at  an  altitude  of  10000  feet  and 
a  Mach  number  of  0.6.  This  yields  a  design  model  that  is  minimum  phase. 
Initially,  the  trim  condition  was  at  the  same  altitude  but  with  a  Mach 
number  of  0.8,  to  be  consistent  with  other  research  done  with  the  same 
model  (Ref  12; 27; 29).  At  this  design  point,  the  eight-state  controller 
model  is  non-minimum  phase.  The  Doyle  and  Stein  robustification  was  applied 
to  this  system  with  some  unexpected  results. 

The  results  of  a  performance  analysis  of  the  eight- state  continuous- 
time  controller  evaluated  against  a  twelve-state  truth  model  are  presented 
in  this  chapter.  First  the  performance  was  evaluated  against  a  twelve- 
state  truth  model  (10000  ft,  Ms0.6).  Then,  the  response  of  the  system  at 
off-design  condition  is  presented,  with  and  without  robustification. 

D.2  Performance  Evaluation  of  a  Non-Minimum  Phase  Design  Model 

The  performance  of  the  non-minimum  phase  system  at  the  design  flight 


condition  with  a  reduced-order  design  model  is  shown  in  Figure  (D-l). 
The  response  of  the  system  is  stable  with  0  converging  to  zero,  and  the 
standard  deviation  converging  to  a  small  finite  value.  The  performance 
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of  this  controller  Is  actually  better  than  the  one  described  in 
Chapters  V  and  VI.  The  transient  time  and  steady-state  error  are  sub¬ 
stantially  better. 

Figure  (D-2)  shows  the  mean  of  0  response  when  the  flight  condition 
is  changed  to  an  altitude  of  20000  feet  and  a  Mach  number  of  0.6.  This 
response  is  still  stable  although  slower  and  more  oscillatory  than  the 
previous  case.  Figures  (D-3)  through  (D-5)  show  the  response  of  the  same 
controller  with  progressively  higher  strengths  of  white  noise  added  to  the 
model  at  the  control  entry  points.  It  is  seen  that  the  stability  of  the 
controlled  system  is  lost  with  the  application  of  the  robustif ication 
technique.  Examination  of  the  eigenvalues  of  the  closed-loop  system 
matrix  disclosed  that,  for  any  non-zero  value  of  q,  some  of  the  eigen¬ 
values  are  driven  into  the  right-half  s-plane. 

If  the  response  of  the  system  at  another  off-design  point  (10000 

feet,  M  ■  0.6)  is  examined  (Figure  D-6) .  It  seen  that  the  mean  of  0  is 

diverging  rapidly.  However,  as  shown  in  Figure  (D-7) ,  if  white  noise  of 
2 

strength  q  -  1000  is  added  to  the  system  model,  the  divergence  is 
considerably  slower.  Figures  (D-8)  and  (D-9)  demonstrate  that  adding 
white  noise  with  higher  strength  will  stabilize  the  pitch  attitude 
response.  The  mean  of  0  is  actually  converging  to  a  steady-state  value. 
Figures  (D-10)  through  (D-12)  show  the  same  trend  for  the  pitch  rate,  q. 

The  figures  in  this  appendix  show  that  the  trends  observed  in 
Chapter  VI  do  not  apply  if  the  model  used  for  controller  and  Kalman  filter 
design  is  non-minimum  phase.  A  case  was  shown  where  the  stability  of 
the  system  at  an  off-design  flight  condition  was  recovered  by  applying 


Figure  D-6:  Unrobustif ied  Kean  Response  of  Q 
at  an  Off-Design  Condition 


TIME.  T.  SECONDS 


Figure  D-7:  Mean  of  Theta  With  White  Noise  Addition 


Figure  0-8:  Mean  of  Theta  With  White  Noise  Addition 


q2  -  (1000)2 
H  -  10000  ft 


-  (1000) 2 

-  10000  ft 

-  0.6 


the  robustification  technique.  However,  the  noise  addition  destabilized 
the  response  of  the  system  at  another  flight  condition  that  was  initially 
stable. 

Reference  28  deals  with  the  robustification  technique  of  adding 
time-correlated  noise  to  a  system  model  at  the  control  entry  points.  It 
states  that  this  method  is  not  constrained  to  minimum  phase  models  as  in 
the  Doyle  and  Stein  technique.  This  claim  was  not  examined  in  this  thesis 
however,  the  models  used  would  form  a  good  basis  for  future  research  in 
this  area. 
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